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ABSTRACT 


Recent  interest  in  positioning  cruise  missile  flight 
control  surfaces  using  electromechanical  actuation  has 
prompted  a  detailed  study  of  brushless  dc  motor  performance 
in  such  an  application.  While  the  superior  response 
characteristics  of  these  electronically  commutated  motors 
are  particularly  well  suited  to  unidirectional  velocity 
drives,  destructive  electrical  transients  associated  with 
rotational  reversals  of  the  motor  limit  its  positioning 
performance.  This  thesis  involves  computer  aided  design  of 
a  functionally  robust  brushless  dc  motor  position 
controller  using  pulse  width  modulation.  Lumped  parameter 
model  simulation  and  phase  plane  analysis  were  performed  to 
attain  a  preliminary  parametric  design  of  the  controller. 
Comprehensive  electrical  and  mechanical  analyses  were 
conducted  using  detailed  model  simulation  to  arrive  at  the 
final  design  by  parametric  optimization.  FORTRAN  source 
code  listings  for  all  simulations  discussed  in  this  thesis 
are  appended  and  were  run  on  a  personal  computer. 
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I.  INTRODUCTION 

A.   BACKGROUND 

The  ever  increasing  demand  for  small,  high  performance 
motors  for  use  in  such  applications  as  missile  flight  and 
space" vehicle  control  actuators,  robotics,  and  disk  drives, 
justify  development  of  brushless  dc  motor  technology. 

Although  conventional  dc  motors  are  highly  efficient 
and  are  proven  to  be  well  suited  for  servo  motor 
application,  brushless  dc  motors  are  generally  superior  in 
performance.  Perhaps  the  most  significant  factor  in  the 
recognition  of  the  permanent  magnet  dc  motor  as  a  viable 
electro-mechanical  actuator  is  the  recent  advances  made  in 
the  area  of  rare-earth  magnetic  materials.  Despite  the 
increased  initial  cost  of  samarium-cobalt,  for  example,  its 
characteristically  high  magnetic  remanence  and  coercive 
force  provide  about  twice  the  flux  density  of  a  similar 
ferrite  magnet.  The  increased  torque-to-inertia  ratio  is 
desired  in  high  performance  actuators.  Additionally, 
improvements  in  semiconductor  technology  have  further 
enhanced  the  realization  of  electronic  commutation.  Rapid 
switching  characteristics  and  low  power  consumption  of  solid 
state  devices  have  widened  the  gap  in  performance  between 
brushless  and  conventional  dc  motors.  Field  windings  of  a 
brushless  dc  motor  are  located  in  the  stator  with  permanent 
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magnet  in  the  rotor  and  commutation  is  performed  using 
solid  state  devices,  resulting  in  cooler  motor  operations. 
Inherent  to  the  removal  of  mechanical  brushes  and 
commutators  is  the  elimination  of  arcing  and  general 
maintenance  associated  with  conventional  dc  motors.  The 
physical  separation  of  commutation  electronics  and  the  motor 
provide  for  a  much  smaller  actuator,  capable  of  functioning 
in  areas  previously  thought  to  be  too  restrictive  for 
electro-mechanical  actuation. 

B.   PURPOSE 

Although  application  of  brushless  dc  motors  is  rapidly 
expanding,  their  popular  use  is  inhibited  by  the  requirement 
for  relatively  complex  control  and  power  conditioning 
electronic  circuitry.  The  intrinsic  high  performance 
characteristics  of  these  electronically  commutated  motors 
are  particularly  well  suited  to  velocity  devices,  where  the 
direction  of  rotation  is  not  routinely  reversed.  Thus, 
recent  exploitation  has  been  primarily  confined  to  variable 
speed  drives.  The  intent  of  this  study,  however,  is  to 
design  a  functionally  robust  positioning  device  capable  of 
cruise  missile  fin  actuation  over  a  broad  range  of  missile 
flight  dynamics. 

Unlike  the  unidirectional  kinematics  associated  with 
velocity  controlled  motors,  positioning  response  is 
invariably  characterized  by  rotational  reversals.   While  the 
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superior  torquing  capability  of  brushless  dc  motors  supports 
high  performance  position  control,  the  electronic  components 
which  facilitate  commutation  are  subjected  to  excessive 
voltage  transients  and,  hence,  reduced  operational 
reliability.  The  central  theme  of  this  study  involves  the 
design  compromises  required  between  system  performance  and 
corresponding  electrical  characteristics. 

C .   APPROACH 

Graphic  techniques  employed  in  this  thesis  are 
supported  by  a  variety  of  interactive  computer  aided  design 
developed  specifically  for  studying  the  behavior  of 
brushless  dc  motors.  Previous  efforts  by  Thomas  [Ref.l]  and 
MacMillan  [Ref.2]  using  the  IBM  370  mainframe  compiler  serve 
as  a  foundation  from  which  this  study  stems.  All  simulation 
is  performed  on  a  microcomputer  rather  than  the  IBM  370 
mainframe,  and  lower  level  programming  in  FORTRAN77  replaces 
the  Continuous  System  Modeling  Program  (CSMP)  language 
[Ref.3].  While  CSMP  provides  an  excellent  environment  for 
general  simulation,  it  impedes  programming  accessibility  to 
various  structural  mechanisms  and  primarily  provides  output 
characteristics  of  imbedded  functions.  Along  with  enhancing 
process  visibility,  coding  in  FORTRAN  facilitates  program 
portability.  An  objective  of  this  thesis  is  delivery  of 
appropriate  design  tools  to  support  on-going  efforts  in 
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brushless  dc  motor  development  at  Naval  Weapons  Center 
(NWC) ,  China  Lake. 

Correlation  between  electrical  and  mechanical  response 
characteristics  of  brushless  dc  motors  is  prerequisite  to 
the  design  problem  and  best  determined  with  the  motor 
configured  as  an  open  loop  velocity  device.  Power 
conditioner  modifications  which  reduce  high  voltage 
transients  are  investigated.  Pulse  width  modulation  is 
examined  as  a  method  for  providing  accurate  position  control 
in  a  manner  congruous  with  power  conditioner  electronic 
limitations. 

Optimal  selection  of  design  parameters  cannot  readily 
be  made  with  the  detailed  model  of  MacMillan  due  to  the 
degree  of  its  complexity.  Therefore,  preliminary  design  is 
accomplished  using  lumped  parameter  modeling  which  provides 
simulation  simplicity,  speed,  and  insight.  Additionally, 
with  limited  availability  of  manufacturer's  and  experimental 
performance  data,  which  is  summarized  in  [Refs.4&5],  the 
simplified  model  provides  an  excellent  means  of  validation 
and  verification  of  the  brushless  dc  motor  simulation. 

Phase  plane  methods  used  in  this  study  support  the 
graphic  nature  of  nonlinear  design  and  provide  considerable 
insight  not  only  to  system  performance,  but  also  to  the 
motor's  dynamics.   The  culmination  of  this  study  involves 
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analysis   of  the   linearly  approximated  design  with  the 
brushless  dc  motor  computer  simulation. 
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II.  MODEL  DESCRIPTION 

A .   BACKGROUND 

Previous  efforts  in  brushless  dc  motor  simulation  at 
NPS  have  exploited  the  IBM  370  mainframe  and  Continuous 
System  Modeling  Program  (CSMP) .  Significant  attractions  of 
these  assets  include  programming  simplicity  and 
computational  versatility  due  mostly  to  stiff  integration 
methods  available.  However,  current  microprocessor 
capabilities  justify  the  development  of  such  a  simulation 
for  analysis  on  a  personal  computer. 

The  programming  language  chosen  for  this  undertaking  is 
Microsoft  FORTRAN77  V3.31.  Graphic  output  is  attained  via 
subroutine  calls  to  Plotworks  PLOT88  graphics  library. 
Because  of  the  intense  computational  demand  of  the 
simulation,  an  INTEL  8087  numeric  co-processor  was 
exploited. 

The  motivation  for  conducting  such  a  study  on  a 
personal  computer  lies  in  the  inherent  portability  of  the 
product.  On-going  efforts  at  NWC,  China  Lake  in  brushless 
dc  motor  design  and  analysis  are  not  fully  benefited  by 
present  NPS  computer  simulations  because  of  mainframe 
inaccessibility.  Additionally,  batch  processing  of  CSMP 
simulation  results  in  cumbersome  development  of  the  model. 
While  microprocessor  architecture  lacks  the  computational 
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power  of  the  mainframe,  it  is  superior  in  terms  of 
portability  and  work  station  availability.  All  simulations 
conducted  in  this  study  were  performed  on  INTEL  8088/8086 
machines,  although  the  universal  nature  of  FORTRAN  coding 
could  be  easily  implemented  on  any  machine  capable  of  being 
programmed  in  FORTRAN.  The  source  code  for  the  detailed 
brushless  dc  motor  simulation  program  is  listed  in  Appendix 
A. 

The  basic  modeling  structure  delineated  in  MacMillan's 
work  [Ref.2]  is  illustrated  in  Figure  2.1  and  serves  as  the 
starting  point  of  this  study.  Based  on  the  assumption  that 
the  network  is  balanced  and  the  power  supply  configuration 
is  split,  the  relatively  complex  3-phase  bridge  circuit 
shown  in  Figure  2.2  simplifies  into  the  two  window  network 
of  Figure  2.3  [Ref.4].  Back  emf  voltage  of  each  phase  is 
modeled  by  MacMillan  and  summed  two  at  a  time  to  determine 
loop  currents.  Reference  2  gives  a  detailed  development  of 
the  power  conditioner  model  which  includes  assumptions  for 
the  switching  transistor  dynamics  used  in  commutation  as 
well  as  the  development  of  the  harmonic  air-gap  flux  used  in 
the  motor  model . 
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Figure   2 . 2      Three  Phase  Bridge  Circuit 
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Figure   2 . 3      Two  Window  Equivalent   Circuit 
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B.   SIMULATION  METHOD 

Since  the  simulation  environment  intrinsic  to  CSMP  is 
not  available  in  FORTRAN,  a  viable  means  of  dynamic 
programming  was  devised.  Natural  parallel  processing 
observed  in  the  behavior  of  electronic  components  of  the 
motor  is  simulated  using  iterative  numerical  techniques. 

Continuous  system  modeling  is  attained  via  the  dynamic 
solution  of  two  nested  systems  of  coupled,  nonlinear 
differential  equations.  The  inner  loop  establishes 
incremental  states  of  motor  current.  Using  Thevenin 
equivalence  techniques,  potential  is  applied  across 
nonlinear  resistance.  This  resistance  is  dependent  upon  the 
state  of  diodes  and  transistors,  as  well  as  the  linear 
resistance  of  the  phase  windings.  An  adaptive  Newton-like 
method  for  solving  these  equations  was  developed.  Of 
particular  interest  in  the  inner  loop  is  the  presence  of 
multiple  solutions,  where  lax  iterative  methods  could  result 
in  convergence  to  an  incorrect  solution.  Specifically,  the 
parallel  relationship  between  the  nonlinear  equivalent 
resistance  and  motor  phase  current  allow  for  convergence  to 
either  the  low  or  high  diode  resistance  solution.  This  is 
particularly  prevalent  during  periods  of  diode  free-wheeling 
associated  with  commutation  switching.  The  numerical 
solution  of  the  inner  system  of  coupled  equations  becomes 
extremely  stiff  and  voltage  sensitive  near  the  bias 
threshold  of  the  protective  diode.   A  quantized  two-state 
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solution  exists  over  a  narrow  range  of  inputs,  resulting  in 
somewhat  unpredictable  numerical  convergence  and  possible 
local  instability.  One  solution  for  phase  current 
incorporates  a  relatively  fast  time  constant  due  to  the  high 
equivalent  resistance  contributed  by  the  non-conducting 
diode,  while  the  conducting  diode  solution  is  described  by  a 
slower  time  constant.  - 

The  stiff  characteristics  of  the  inner  loop  are 
adequately  handled  through  the  use  of  a  cautious  iterative 
method  which  is  invoked  prior  to  numerical  bracketing  of  the 
actual  solution.  During  non-bracketed  iterations,  the 
simulation  step  is  halved  and  the  system's  condition  is 
investigated  to  ensure  that  the  solution  has  not  been 
bypassed.  This  halving  technique  increases  the  resolution 
of  the  high/low  resistance  solutions  which  might  otherwise 
mask  each  other.  This  method  works  reasonably  well,  but 
numerical  "chattering"  is  still  observed  during  conditions 
immediately  prior  to  diode  turn-off.  Although  available 
stiff  integration  methods  would  further  minimize  the 
numerical  oscillation,  size  and  speed  constraints  prohibit 
such  integration  in  this  program. 

The  outer  loop  solves  the  motor's  position  and  velocity 
states  and  the  induced  back  emf  characteristics 
simultaneously.   A  simple  Newton  iterative  scheme  works  well 
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on  the  outer  loop  because  of   filtering  and  smoothing 
provided  by  the  motor's  low  pass  response  characteristics. 

Despite  numerically  stiff  behavior,  the  highly 
nonlinear  and  discontinuous  nature  of  the  model  supports  the 
use  of  a  simple  small  step  trapezoidal  integrator.  Variable 
step  integration  involves  considerable  coding  structure  and 
computation  time  during  stiff  conditions,  neither  of  "which 
is  well  suited  for  the  limited  architecture  of  a  personal 
computer.  Direct  comparison  of  fixed  step  results  gained  in 
this  simulation  with  variable  step  results  described  by 
MacMillan  support  the  validity  of  fixed  step  integration. 
Convergence  criteria  establish  the  solution  accuracy  and 
efficiency  and  are  monitored  during  the  execution  of  the 
simulation  program.  Stiff  numerical  conditions  which  burden 
fixed  step  integration  are  identified  and  displayed  at  the 
console. 

The  successful  modeling  of  an  analog  system  in  a 
digital  simulation  relies  heavily  on  the  step  size. 
Particularly,  the  discontinuous  nature  of  this  model 
increases  the  likelihood  of  false  response  characteristics 
if  the  simulation  interval  is  not  carefully  selected. 
Oscillations  due  to  subharmonic  interaction  between  the 
simulation  increment  and  the  discontinuous  pulse  width 
modulated  forcing  function  may  result.  Position  control 
with  pulse  width  modulation  is  best  simulated  using  a  small, 
fixed  step  rather  than  a  variable  step  scheme  common  to 
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stiff  integrators.  As  a  general  rule  of  thumb,  the 
simulation  step  increment  should  be  at  least  an  order  of 
magnitude  less  than  the  PWM  reference  period  to  eliminate 
aliasing  and  other  problems  associated  with  periodically 
sampled  systems. 

C.   POWER  CONDITIONER  SIMULATION 

Accurate  modeling  of  power  conditioning  and  commutation 
in  brushless  dc  motors  requires  explicit  definition  of  the 
physical  behavior  of  power  transistors  and  their  associated 
protective  diodes.  Lower  level  programming  is  required  to 
properly  imbed  the  conditions  necessary  to  naturally  trigger 
the  diodes  and  permit  realistic  simulation  of  their 
performance.  It  is  presumptuous  to  force  the  diodes  into 
the  conducting  state  during  the  entirety  of  their  thirty 
mechanical  degrees  of  protective  duty.  Simulation  of  the 
natural  behavior  of  electronic  components  is  of  particular 
importance  when  the  model  is  configured  for  position 
control.  Reversal  of  the  direction  of  rotation  may  be 
ordered  by  the  controller  at  any  time  or  position.  The 
randomness  of  the  forcing  function  as  observed  by  the  power 
conditioning  components  necessitates  that  behavior 
algorithms  be  generalized  to  ensure  simulation  robustness. 

Coil  inductance  action  in  brushless  dc  motors  is 
significant  and  deserves  particular  attention  in  this  study. 
When  current,  I,  flows  into  a  circuit  whose  inductance  is  L, 
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the  electromagnetic  energy,  E,  will  be  stored  in  it  and  is 
given  by  Equation  2.1. 

E=|LI2  (2.1) 


The  corresponding  voltage  across  the  inductive  coil  is 
determined  by  the  change  in  current  flow  through  it  and  is 
described  by  Equation  2.2. 


V  =  L  di  (2.2) 

dt 


When  the  inductive  circuit  is  opened,  the  voltage 
induced  is  generally  sufficient  to  forward  bias  the 
appropriate  free-wheeling  diode  and  cause  it  to  conduct.  As 
long  as  a  low  resistance  return  path  for  the  exponentially 
decaying  current  flow  is  provided,  the  corresponding  voltage 
response  is  acceptable.  If  the  protective  diode  changes  to 
a  non-conducting  state  because  of  component  failure  or 
reverse  bias  conditions,  the  equivalent  resistance  of  the 
return  path  for  current  flow  becomes  very  high.  The 
resulting  faster  time  constant  of  the  circuit  promotes  rapid 
dissipation  of  any  electromagnetic  energy  stored  in  the 
inductive  coil.  If  significant  energy  remains  stored  in  the 
coil  at  the  time  of  diode  turn  off,  a  large  di/dt  and 
undesired  high  voltage  condition  will  result. 
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Figures  2.4  through  2.9  describe  step  velocity  current 
and  voltage  response  characteristics  for  conditions  where 
the  protective  diodes  are  both  functional  and  inhibited. 
The  key  observations  made  from  these  six  plots  involve 
current  decay  rate  dependence  on  the  functional  status  of 
the  protective  diodes  and  the  corresponding  voltage 
conditions  observed  at  the  power  transistors.  Unacceptably 
high  voltage  transients  that  occur  across  the 
transistor/diode  pair,  as  shown  in  Figure  2.8,  result  when 
free-wheeling  diodes  malfunction.  Voltage  spikes  are 
limited  to  800  volts  in  the  computer  simulation  for  purposes 
of  graphic  scaling.  In  Figure  2.9,  functioning  diodes  are 
observed  to  reduce  peak  voltage  values  to  240  volts. 
However,  when  current  is  decayed  with  a  time  constant 
smaller  than  the  simulation  step  size,  discontinuous 
behavior  results.  As  long  as  current  decay  is  numerically 
discontinuous,  the  induced  coil  potential  determined  by 
Equation  2.2  is  principally  dependent  on  the  simulation  step 
size.  Therefore,  the  magnitude  of  the  voltage  spike 
resulting  from  the  rapid  decay  of  12  amps  of  phase  current 
is  dominated  by  coil  potential  and  may  be  approximated 
analytically. 

di         AI 

V  =  Leq  dt  ~  2Leq  AT 

AI  =  12  amps  ;  AT  =  4rdecay  =  4Leq/Req  -  0.64  ^volts 

V  -  30,000  volts 
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For  di  to  be  approximated  as  Al  at  a  value  of  12  amps, 
then  At  may  be  chosen  as  small  as  four  times  the  high 
resistance  decay  time  constant,  rdecay*  Clearly,  30,000 
volts  of  potential  across  a  power  transistor  is  not 
realizable  and  junction  punch  through  would  most  likely 
relax  this  condition.  However,  resulting  transistor  damage 
is  highly  probable.  The  acceptable  peak  voltage  conditions 
depicted  in  Figure  2.9  are  affected,  but  not  dominated,  by 
induced  coil  potential.  As  shown  in  Figures  2.5  and  2.7, 
motor  and  phase  current  is  decayed  with  the  low  resistance 
time  constant,  allowing  reasonable  dissipation  of  stored 
electromagnetic  energy  from  the  coil. 

Digital  simulation  of  an  analog  component  or  circuit 
generally  may  be  accomplished  using  numerical  methods  and  a 
step  size  sufficiently  small  to  preserve  the  formation  of 
its  continuous  response  characteristics.  However,  the 
parallel  processing  behavior  of  the  inductive  coil  in  a 
highly  nonlinear  and  discontinuous  environment  is  not 
modeled  as  easily. 

A  protective  diode  is  triggered  when  its  biasing 
threshold  is  exceeded,  usually  the  result  of  commutation 
switching  action.  Each  finite  increment  of  the  digital 
simulation  is  uniquely  described  by  a  set  of  state 
conditions.  The  modeling  of  ideal  diode  characteristics 
introduces  discontinuous  behavior  in  the  circuit  and 
precludes  numerical  solution  using  simple  iterative  methods. 
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Figure  2.4  Motor  Current  Response  with  Diodes  Inhibited 
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Figure  2.8  Voltage  Response  (Q5)  with  Diodes  Inhibited 


VOLTAGE  RESPONSE  AT  POWER  TRANSISTOR  *5 

o 

PROTECTIVE  DIODES  FUNCTIONING 

a 

CD 

_►_.     a 

A 

o    =5 
3   -  - 

ft 

A 

LO 

°  s 

CD 

U 

s 

J 

i 

CD    ~ 

0 

.000 

i             i             i             i             i             i 

0.017           0.033           0.050           0.067           0.083           0.100 

TIHE    (seconds)        *10'' 

Figure  2.9  Voltage  Response  (Q5)  with  Diodes  Functioning 


31 


Consider  the  incremental  voltage  and  current  response  of  an 
affected  phase  leg  immediately  following  commutation 
switching.  The  voltage  response  of  the  inductive  coil  is 
determined  by  the  current  flow  to  which  the  coil  is 
subjected.  When  the  current  flow  is  apparently  cutoff,  a 
large  and  negative  induced  voltage  is  immediately  observed. 
This  -voltage  condition  is  sufficient  to  forward  bias  the 
protective  diode  and  provide  a  low  resistance  return  path 
for  the  decaying  current.  However,  the  low  resistance  and 
positive  current  flow  result  in  a  voltage  which  reverse 
biases  the  diode.  This  apparent  toggling  of  the  diode 
presents  difficulty  in  the  numerical  convergence  and 
instantaneous  solution  for  each  affected  step  in  the 
simulation. 

If  the  step  size  could  be  reduced  to  an  inf initesmally 
small  period,  analog  simulation  would  be  realized  and  the 
diode- would  behave  realistically.  Continuous  modeling  is 
alternatively  achieved  through  programming  methods.  The 
polarity  of  the  coil  potential  is  fixed  and  not  allowed  to 
toggle  once  the  diode  has  been  forward  biased,  thereby 
eliminating  the  numerical  instability  caused  by  the 
discontinuous  behavior  of  the  diode.  Electromagnetic  energy 
is  allowed  to  dissipate  until  the  magnitude  of  the  coil 
potential  is  insufficient  to  sustain  a  forward  bias 
condition.     This   method   provides   robust   modeling   of 
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inductive  behavior  and  eliminates  the  undesired  effects  of 
digital  sampling. 

This  chapter  has  described  numerical  methods  employed 
to  facilitate  simulation  of  a  brushless  dc  motor  on  a 
personal  computer.  Model  development  has  focused  primarily 
on  electronic  commutation  and  power  conditioning.  The  task 
of  buffering  the  voltage  transient  behavior  associated^ with 
commutation  switching  is  investigated  in  Chapter  III. 
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III.  TRANSIENT  RESPONSE  WAVESHAPING 

A.  BACKGROUND 

Relatively  minor  adaptations  to  the  power  conditioning 
model  developed  by  MacMillan  and  illustrated  in  Figure  2.2 
result  in  dramatic  variation  of  the  electronic  environment 
to  which  the  solid  state  components  are  subjected.  In 
general,  modifications  which  limit  hazardous  voltage 
conditions  at  the  power  transistors  during  commutation 
switching  restrict  the  motor's  overall  torque  capability. 

Stiff  current  characteristics  indicate  exaggeration  of 
the  transient  voltage  response  acting  on  solid  state 
devices.  Refinement  and  reshaping  of  the  phase  current 
waveforms  may  be  undertaken  with  the  prospect  of  minimizing 
adverse  voltage  effects. 

Modifications  to  power  conditioning  circuitry  is 
investigated  in  this  chapter  using  step  velocity  response 
characteristics  of  the  brushless  dc  motor.  Unidirectional 
kinematics  associated  with  open  loop  behavior  facilitate 
response  waveshaping  without  the  complication  of  rotational 
reversal. 

B.  COMMUTATION  ADVANCE  &  RETARD 

The  switching  logic  detailed  by  Thomas  in  [Ref.l]  for 
motor  rotation  in  clockwise  and  counterclockwise  directions 
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is  summarized  in  Table  I.  This  logic  assumes  maximum 
torquing  conditions;  that  is,  the  rotor  is  located  in  such  a 
position  that  its  field  flux  is  orthogonal  to  the  stator's 
electromagnetic  field.  Hall-effect  sensors  are  used  to 
provide  quantized  rotor  position  information  to  the  power 
conditioner  for  generation  of  sequencing  logic. 

TABLE  I 

SENSOR  AND  SWITCHING  LOGIC 

Rotor         RPS  Clockwise       Counterclockwise 

Position     A   B   C     Ql   Q2   01   £4  Q5   Q6         01  02  03  Q4  05  Q6 

0-30°  101  000110  001001 

30-60°  100  100100  011000 

60-90°  110  100001  010010 

90-120°  010  001001  000110 

120-150°  011  011000  100100 

150-180°  001  010010  100001 

Deviation  from  this  orthogonal  relationship  may  be 
accomplished  by  either  advancing  or  retarding  commutation. 
Displacement  in  relative  angular  position  between  the 
electromagnetic  field  and  the  field  flux  is  attainable 
through  modification  of  the  commutation  sequencing  logic. 

Figures  3.1  through  3.6  describe  the  motor's  electrical 
response  characteristics  when  commutation  is  advanced  and 
retarded.  Operational  reliability  of  the  motor,  which  is 
largely  influenced  by  the  voltage  conditions  experienced  by 
power  conditioning  electronic  components,  must  be  considered 
when   maximizing   its   mechanical   performance.     Numerous 
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Figure   3.1     Motor  Current  Response    (Commutation  Retarded   5°) 
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Figure  3.2  Center  Point  Trajectory  (Commutation  Retarded  5°) 
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Figure  3.3   Motor  Current  Response  (No  Commutation  Offset) 
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Figure  3.4   Center  Point  Trajectory  (No  Commutation  Offset) 


37 


BRUSHLESS  DC  MOTOR  CURRENT  RESPONSE 
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Figure  3.5  Motor  Current  Response  (Commutation  Advanced  5°) 
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Figure  3.6  Center  Point  Trajectory  (Commutation  Advanced  5a) 
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simulations  with  varying  degrees  of  commutation  advance  and 
retard  indicate  maximum  system  responsiveness  at  orthogonal 
field  conditions. 

The  free  floating  center  connection  of  the  wye 
configured  model  (Node  0  in  Figure  2.2)  serves  as  a  common 
voltage  node  for  the  three  phase  network.  This  node  is 
offset  from  its  nominal  value  of  0  volts  when  ~ load 
distribution  of  the  network  is  unbalanced.  The  trajectory 
of  the  center  connection  is  determined  by  Kirchoff's  voltage 
law  and  is  a  function  of  the  generated  back  emf,  phase 
current  through  the  field  windings,  and  the  inductive  coil 
potential.  Back  emf  is  predictable  under  most  load 
conditions  and  may  be  uncoupled  from  the  effects  of  the 
coil.  The  trajectory  provides  a  comprehensive  indication  of 
voltage  transient  behavior  in  the  motor  during  commutation. 
Minimization  of  the  trajectory's  peak  voltage  values  will 
reduce"  high  voltage  conditions  experienced  by  the  power 
transistors. 

It  is  of  particular  interest  to  compare  the  step 
velocity  center  point  trajectory  shown  in  Figure  3.4  with 
the  response  determined  by  MacMillan  and  given  in  [Ref.2, 
Fig. 5. 8].  A  fundamental  premise  of  MacMillan 's  model  is 
that  the  three  phase  network  behaves  in  a  symmetric  fashion. 
This  assumption  permits  the  center  point  trajectory  to  be 
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trajectory  to  be  described  solely  in  terms  of  magnetic  flux 
and  ignores  the  cummulative  effects  of  the  inductive  coil. 

Fin  step  velocity  transient  response  characteristics 
provide  an  appropriate  means  of  quantizing  the  general 
responsiveness  of  the  motor.  Even  during  the  most  demanding 
periods  of  flight  control,  fin  actuation  dynamics  are 
contained  within  the  initial  transient  response  of  the  open 
loop  configured  velocity  device.  A  mechanical  performance 
factor  describing  fin  positioning  responsiveness  may  be 
determined  by  computing  the  normalized  average  slope  of  the 
fin  velocity  step  response  measured  between  0  and  60%  of 
steady  state  velocity.  Figure  3.7  illustrates  the 
quantization  of  mechanical  performance  of  a  brushless  dc 
motor  with  no  commutation  offset. 
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Figure  3.7   Mechanical  Performance  Factor  Description 
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Electrical  performance  is  well  described  by  the  motor's 
center  point  voltage  response.  The  transient  effects  of 
commutation  switching  and  back  emf  generation  characterize 
the  trajectory.  Excessively  high  voltage  conditions 
observed  at  the  center  connection  correspond  to  unacceptable 
behavior  at  the  power  transistors.  Therefore,  electrical 
performance  is  quantized  by  normalizing  average  peak  values 
of  the  center  point  trajectory. 

Figure  3.8  illustrates  the  relationship  between 
commutation  offset  and  electrical-mechanical  performance  of 
the  brushless  dc  motor  for  ±30°  of  commutation  offset  angle. 
Commutation  at  orthogonal  field  conditions  provides  maximum 
system  responsiveness,  which  degrades  in  a  somewhat 
symmetrical  manner  as  advance  and  retard  angles  are 
increased. 

Center  point  trajectory  peak  voltage  values  in  excess 
of  500"  volts  are  illustrated  in  Figure  3.6.  Therefore,  the 
unacceptable  electrical  response  behavior  associated  with 
advanced  commutation  invalidates  its  application  in  this 
design.  Additionally,  significant  retarding  of  commutation 
is  required  to  noticeably  reduce  the  high  voltage  conditions 
associated  with  commutation  switching.  Because  of  the 
substantial  compromise  in  performance  at  these  retarding 
offsets,  neither  commutation  advancing  nor  retarding  was 
deemed  advantageous  and,  therefore,  not  implemented. 
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Figure  3.8   Electrical-Mechanical  Performance  vs  Commutation 
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C.   DIODE  BIAS  THRESHOLD 

The  demanding  operating  conditions  encountered  by  the 
brushless  dc  motor  in  service  necessitate  current  limiting 
protection.  Previous  models  have  provided  this  protection 
with  a  relatively  large  power  supply  series  resistance. 
Fluctuations  in  load  and  general  performance  of  the  motor 
are  comfortably  absorbed  using  such  a  method  of  current 
limitation.  However,  the  scheme  reduces  motor  supply  line 
voltage  to  an  unacceptably  low  level  with  respect  to  biasing 
threshold  requirements  of  the  protective  diodes.  Even 
though  protective  diodes  are  functioning  properly  during 
commutation  switching,  stiff  current  conditions  are  observed 
near  the  peaks  of  current  ripple  in  the  response  shown  in 
Figure  3.3.  During  cyclic  conditions  of  maximum  emf 
generation,  protective  diodes  are  falsely  forward  biased  due 
to  insufficient  line  voltage.  Random  diode  triggering  may 
short-  active  circuits  and  result  in  abrupt  behavior  in 
current  and  voltage  responses. 

Modification  of  the  3-phase  model  shown  in  Figure  2.2 
allows  for  the  same  value  of  equivalent  supply  resistance  to 
be  divided  in  series  across  each  transistor-diode  pair  and 
is  illustrated  in  Figure  3.9.  The  reconfiguration  permits 
selection  of  the  voltage  divider  relationship  necessary  for 
correct  triggering  of  the  protective  diodes  during 
commutation  switching  and  maintains  a  viable  means  of 
current  limiting  protection  through  series  resistance. 
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Figure  3.9  Modified  3-Phase  Bridge  Circuit 
Voltage  divider  percentage  is  determined  by  Equation 


3.1. 


Voltage  Divider  %  - R±n  /  (Rin  +  RQUt) 


(3.1) 


Figures  3.10  through  3.15  illustrate  the  effects  on 
current  and  voltage  response  when  the  free-wheeling  diode's 
bias  threshold  is  varied  by  voltage  divider  adjustment.  As 
observed  in  Figure  3.3,  insufficient  bias  threshold  results 
in  unexpected  diode  firing  and  short  circuiting  of  the 
affected  phase.  On  the  other  hand,  excessive  bias  threshold 
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conditions,  such  as  the  63%  voltage  divider  configuration 
illustrated  in  Figures  3.10,  3.12,  and  3.14,  result  in 
premature  cutoff  of  the  protective  diodes  during  free- 
wheeling conditions.  The  electromagnetic  energy  stored  in 
the  coil  is  not  sufficiently  dissipated  through  a  low 
resistance  path  and  high  voltage  conditions  are  observed 
across  the  power  transistors  in  Figure  3.14*  It  is 
interesting  to  note  that  excessive  bias  threshold  conditions 
preclude  forward  biasing  of  protective  diodes  during  only  a 
single  switching  operation  as  illustrated  in  Figure  3.10  at 
t=2. 5msec.  This  is  explained  by  the  velocity  dependence  of 
back  emf.  At  lower  speeds,  the  inductive  coil  is 
insufficiently  supplemented  by  back  emf  generation  to 
forward  bias  the  protective  diode.  At  higher  speeds, 
however,  back  emf  generation  is  significant  and  adequately 
contributes  towards  satisfying  diode  triggering  criteria.  A 
50%  voltage  divider  ensures  robust  diode  operation  and 
provides  effective  current  limiting.  The  corresponding 
electrical  transient  characteristics  of  this  configuration 
are  depicted  in  Figures  3.11,  3.13,  and  3.15.  Figure  3.15 
clearly  indicates  reduction  of  the  peak  voltage  accross  the 
transistor. 
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Figure  3.10   Motor  Current  Response  (63%  Voltage  Divider) 
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Figure  3.11   Motor  Current  Response  (50%  Voltage  Divider) 
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PHRSE  C  OPEN  LOOP  CURRENT  RESPONSE 
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Figure   3.12      Phase  Current  Response   {63%  Voltage  Divider) 
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Figure  3.13   Phase  Current  Response  (50%  Voltage  Divider) 
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Figure  3.14   Transistor  #5  Voltage  Response  (63%  Voltage 

Divider) 
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D.   CURRENT  DECAY  TIME  CONSTANT 

The  exponential  decay  of  current  in  a  relaxing  phase  is 
described  uniquely  by  a  dynamic  time  constant.  The 
circuit's  time  constant  is  determined  by  the  phase 
inductance,  L,  divided  by  its  equivalent  path  resistance. 
Previous  modeling  provides  either  high  or  low  path 
resistance  conditions  determined  by  the  state  of*  the 
protective  diode.  A  high  resistance  state  yields  extremely 
fast  time  constants  which  results  in  high  di/dt  values. 
Conversely,  the  low  resistance  state  is  described  by  a 
relatively  slow  decay  transient.  If  the  transient's 
duration  exceeds  the  time  required  for  30°  of  mechanical 
rotation,  then  the  remaining  electromagnetic  energy  stored 
in  the  coil  will  be  exponentially  dissipated  with  the  fast 
time  constant.  This  condition  is  characterized  by  undesired 
high  voltage  transients  across  the  power  transistors  and  is 
found-to  be  more  prevalent  at  higher  operating  speeds  where 
less  time  for  energy  dissipation  is  available. 

The  simulation  program  is  provided  with  an  adjustable 
resistance  placed  in  series  with  each  protective  diode  to 
permit  control  of  the  phase  current's  decay  time  during 
free-wheeling.  Location  of  the  adjustable  resistance 
(RDADJ)  in  the  power  conditioning  model  is  given  in  Figure 
3.9.  Average  response  characteristics  of  the  motor  are 
unaffected  by  this  added  resistance  since  it  is  negligible 
when  compared  to  the  equivalent  loop  resistance.   However, 
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RDADJ  dominates  the  current  decay  return  path  resistance  and 
essentially  determines  the  circuit's  time  constant. 
Physical  implementation  is  feasible  since  the  added  resistor 
is  external  to  the  motor  and  actually  a  component  of  the 
power  conditioner. 

Figures  3.16  through  3.21  graphically  depict  the 
waveshaping  effects  of  RDADJ  on  phase  current  and  transistor 
voltage.  Selection  of  the  rate  adjusting  resistance  is  a 
fairly  straightforward  task  since  it  is  clearly  bounded  by 
its  consequences.  Increased  decay  rate  results  from 
increasing  the  resistance  (RDADJ)  and  corresponds  directly 
to  higher  voltage  transients  at  the  power  transistors. 
Figures  3 . 18  and  3 . 19  illustrate  the  intolerable 
consequences  associated  with  the  selection  of  a  very  fast 
time  constant.  A  3d  resistance  for  RDADJ  improves  the  decay 
time  constant  significantly  with  an  increased  but  acceptable 
transistor  voltage  transient  peak,  which  is  shown  in  Figure 
3.21. 
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Figure  3.16   Phase  C  Current  Response  (RDADJ  =  Oft) 
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Figure  3.17  Transistor  #5  Voltage  Response  (RDADJ  =  Ofi) 
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Figure  3 . 18   Phase  C  Current  Response  (RDADJ  =  5fi) 
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Figure  3.19   Transistor  #5  Voltage  Response  (RDADJ  =  5ft) 
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Figure  3.20   Phase  C  Current  Response  (RDADJ  =  30) 


VOLTAGE  RESPONSE  OF  P0HER  TRANSISTOR  *5 

G9 

o 

cm 

3  OHM  OECRT  TIHE  CONSTANT  ADJUSTMENT 

o 

=3 

O 
a* 
CM    " 

~co 

f\ 

CD 
LO 

£=»     = 

>-     a 

a 
oo  " 

3 

r                  i 

■■   1 

o.ooo 

0.100           0.200           0.300           0.400           0.500 
TIHE    (seconds)        ilO"2 

0.599 

Figure  3.21   Transistor  #5  Voltage  Response  (RDADJ  =  30) 
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Step  velocity  response  waveshaping  has  been  exploited 
to  optimize  the  transient  characteristics  of  the  brushless 
dc  motor  and  its  associated  electronic  commutation 
circuitry.  Many  of  the  benefits  of  such  refinement  are  not 
readily  apparent  during  unidirectional  rotation.  However, 
the  highly  accentuated  transient  behavior  associated  with 
closed  loop  position  control  is  significantly  affected  by 
these  modifications  and  will  receive  further  attention  in 
the  Chapter  IV. 


54 


IV.  CLOSED  LOOP  CONSIDERATIONS 

A.   BACKGROUND 

NPS  studies  of  brushless  dc  motors  primarily  support 
variable  speed  control  applications  [Refs.  1,2,6,7].  Very 
limited  documentation  concerning  its  viability  in  closed 
loop  position  control  appears  in  the  referenced  literature. 
Previous  research  at  NPS  has  also  been  restricted  mainly  to 
open  loop  (velocity)  performance  characteristics.  However, 
brushless  dc  motor  cruise  missile  fin  control  was 
investigated  and  simulated  by  Franklin  using  an  equivalent 
lumped  parameter  model  [Ref.7].  Additionally,  MacMillan's 
detailed  model  provides  rudimentary  observation  of  motor 
current  transient  behavior  when  rotational  direction  is 
reversed. 

In  addition  to  the  unidirectional  kinematics  normally 
associated  with  variable  speed  control,  closed  loop 
position  control  includes  such  conditions  whereby 
mechanical  rotation  and  electrically  developed  torque 
oppose  each  other.  The  intention  of  this  chapter  is  to 
study  closed  loop  positioning  characteristics  of  brushless 
dc  motors,  with  particular  emphasis  on  the  transient 
behavior  associated  with  reversing  rotational  direction. 


55 


B.   CLOSED  LOOP  MECHANICS 

The  mechanics  of  position  control  of  a  permanent  magnet 
dc  motor  are  broadly  described  by  three  electromechanical 
conditions.  The  natural  operational  state  of  a  working  dc 
motor  is  known  as  motoring.  This  condition  is  characterized 
by  electrical  to  mechanical  energy  conversion  and  occurs 
when  'the  motor  is  driven  between  zero  and  steady  ~state 
speeds.  When  the  motor  is  forced  to  rotate  at  a  greater 
rate  than  its  steady  state  speed  either  by  external 
disturbance  or  decreased  supply  voltage,  generator  action 
is  realized.  Generation  converts  mechanical  to  electrical 
energy  and,  if  suitably  configured,  can  be  used  to 
replenish  the  power  supply  through  regeneration.  The 
mechanical  energy  consumed  in  electrical  regeneration 
dynamically  brakes  motor  rotation  and  provides  increased 
deceleration  during  relaxation  conditions.  The  third 
operational  state  is  forced  braking  and  occurs  when  the  motor 
is  forced  to  rotate  against  its  present  direction. 
Associated  with  the  resulting  intense  rotational 
deceleration  are  electrical  transients  -that  are  accentuated 
and  often  result  in  destructive  magnitude  of  current 
through  and  voltage  across  the  power  transistor/diode  pair. 
[Ref .8] 


56 


C.   FOUR  QUADRANT  OPERATION 

The  electronic  commutation  of  a  three  phase,  4-pole 
brushless  dc  motor  configured  for  position  control  may  be 
more  comprehensively  described  as  four  quadrant  operation 
[Ref.9],  Following  in  similar  manner,  Figure  4.1 
illustrates  the  electromechanical  conditions  describing  the 
four  -  quadrants.  Electromagnetic  field  orientation 
determines  the  electrically  developed  torque,  T,  which 
forces  rotation  in  a  prescribed  direction.  This  torquing 
direction  is  denoted  by  the  variable  "DIR"  in  the  computer 
simulation  and  is  accomplished  through  logic  sequencing  of 
the  power  transistors.  Actual  mechanical  rotation,  u, 
describes  the  kinematic  state  of  the  rotor. 

The  transient  dynamics  involved  in  attaining  positional 
steady  state  may  be  classified  as  forward  motoring,  forward 
braking,  reverse  motoring,  and  reverse  braking.  Except  for 
directional  differences,  response  characteristics  of 
forward  and  reverse  motoring  are  symmetric,  as  are  those  of 
forward  and  reverse  braking.  As  shown  in  Figure  4.1, 
reversal  of  commutation  direction  may  be  buffered  by 
generator  action  if  any  degree  of  system  relaxation  is 
provided  by  the  controller. 

Quadrants  II  and  IV  of  Figure  4.1  describe  motoring 
conditions,  where  actual  mechanical  rotation  (w)  and 
electrically  developed  torque  (T)  are  in  the  same 
direction.     During   this   mode   of   operation,   response 
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characteristics  are  electrically  similar  to  unidirectional, 
open  loop  behavior.  Transient  conditions  are  relatively 
well  behaved  since  protective  diodes  are  able  to  dissipate 
electromagnetic  energy  stored  in  relaxed  phase  inductive 
coils  as  intended.  The  back  emf  generated  while  motoring 
converts  the  mechanical  energy  of  rotation  to  electrical 
energy  proportional  to  the  speed  of  rotation  and  is 
opposite  in  polarity  of  the  forcing  potential.  The 
superposition  of  source  and  generated  voltage  net  a  reduced 
electromotive  force  and,  therefore,  impede  and  eventually 
limit  the  motor's  rotational  rate. 

Forced  braking  immediately  follows  the  reversal  of 
electronic  commutation  and  is  illustrated  in  quadrants  I 
and  III  of  Figure  4.1.  This  condition  is  commonly  referred 
to  as  plugging  in  a  brush-type  motor  and  occurs  when  the 
applied  voltage  is  reversed  in  polarity.  Plugging  of 
brushless  dc  motors  is  accomplished  through  commutation 
logic  sequencing,  since  supply  voltage  polarity  is  fixed. 
Consider  the  lightly  damped  fin  angle  stepped  response  also 
shown  in  the  figure.  When  the  forward  running  motor  comes 
to  zero  speed  under  braking  action  at  t=t1;  it 
automatically  gets  accelerated  in  the  reversed  direction 
since  the  commutation  logic  for  forward  braking  and  reverse 
motoring  is  identical.  While  rapid  braking  and  reversing 
characteristics  are  desired  in  a  position  control  system, 
the   exaggerated   transient   behavior   of   the   motor   is 
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electronically  demanding  and  may  result  in  damage  to  solid 
state  devices. 

Figure  4.1  also  indicates  the  presence  of  generator 
action  immediately  adjacent  to  commutation  reversal.  If 
the  controller  provides  suitable  conditions  for  natural 
response  of  the  motor,  energy  is  converted  by  regenerative 
processes  and  dynamic  braking  is  attained.  Controllers 
which  operate  with  a  dead  zone  or  have  soft  response 
characteristics  often  promote  generator  action  and  are 
associated  with  better  behaved  transients.  Conversely, 
stiff  controllers  with  no  dead  zone,  such  as  an  ideal 
relay,  do  not  experience  natural  response  conditions  when 
plugged.  Therefore,  the  buffering  effect  provided  by 
dynamic  braking  is  not  exploited  by  high  performance 
controllers  and  the  corresponding  electrical  response  is 
characterized  by  excessive  transient  behavior. 
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Figure  4.1   Four  Quadrant  Operation  of  a  Brushless  DC  Motor 
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D.   TRANSIENT  BEHAVIOR 

The  excessive  transient  behavior  observed  during 
braking  is  explained  by  several  factors.  Generated  back 
emf  is  now  of  the  same  polarity  as  the  forcing  potential 
and  the  superposition  of  source  and  generated  voltages  net 
an  enhanced  electromotive  force.  The  resulting 
responsiveness  of  the  system,  as  well  as  its  transient 
behavior,  is  increased. 

Electromagnetic  energy  stored  in  an  apparently  cutoff 
phase  inductive  coil  for  the  three  phase,  4-pole  motor  is 
intended  to  be  dissipated  within  the  time  required  for 
thirty  degrees  of  mechanical  rotation.  When  the  motor  is 
initially  plugged,  less  time  is  likely  to  be  available  for 
decay  and  high  voltage  conditions  may  result. 

During  forced  braking  conditions,  the  direction  of 
actual  mechanical  rotation  (w)  opposes  the  prescribed 
commutation  logic  sequence  and  results  in  commutation 
switching  performed  in  reverse  order.  This  apparent  back- 
stepping  through  the  sequencing  logic  results  in  reversal, 
rather  than  redirection,  of  phase  current  flow  within  the 
motor.  The  effects  of  rapidly  reversing  current  flow 
within  the  motor  is  significant  due  to  the  nature  of  the 
inductive  coil  and  result  in  intolerable  voltage 
transients. 

The  commutation  logic  which  sequences  the  switching  of 
power  transistors  should  be  sensitive  to  the  controller's 
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mode  of  operation.  While  in  the  forced  braking  mode, 
complete  transistor  switching  cannot  be  performed 
simultaneously  without  catastrophic  results,  and  a  two  step 
sequence  is  called  for.  Stored  coil  energy  in  the  affected 
phase  should  be  minimized  prior  to  reversing  the  direction 
of  the  current  flow  through  it.  Therefore,  a  time  delay  is 
required  between  switching  off  the  existing  current  and 
switching  on  the  reversing  current.  During  this  momentary 
period  of  natural  response,  phase  current  should  be  decayed 
with  a  reasonable  time  constant  to  reduce  the  voltage 
transients  associated  with  current  reversal.  If  the 
commutation  delay  exceeds  the  current  decay  time,  near 
complete  dissipation  of  the  energy  stored  in  the  coil  will 
be  realized  and  the  reversal  of  current  can  be  performed 
acceptably. 

The  rate  of  decay  of  electromagnetic  energy  stored  in  a 
relaxed  coil  is  determined  by  the  circuits  time  constant. 
The  addition  of  a  3fl  resistance  in  the  decay  path,  as 
discussed  in  Chapter  III,  provides  more  rapid  dissipation 
of  the  stored  energy.  Less  delay  time  is  required  for 
faster  decaying  current  conditions,  thereby  minimizing 
system  performance  degradation  during  commutation 
switching.  Figure  4.2  depicts  a  typical  first  reversal 
encountered  during  fin  position  response  when  a  10°  step  of 
demand  is  applied  using  an  ideal  relay  type  controller. 
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Figure  4.2   Fin  Reversal  During  Position  10°  Step  Response 

The  effect  on  current  and  voltage  waveform  of 
commutation  switching  delay  in  fin  position  control  during 
this  reversal  is  illustrated  in  Figures  4 . 3  through  4.6. 
Transient  current  behavior  and  center  connection  voltage 
response  (Node  O)  with  no  commutation  delay  applied  are 
shown  in  Figures  4.3  and  4.5.  Current  is  observed  to  be 
decayed  very  rapidly  in  Figure  4 . 3  when  plugged  due  to  the 
nearly  instantaneous  reversal  of  phase  current.  The  rapid 
change  in  current  flow  induces  very  large  coil  potential, 
exhibited  in  Figure  4.5  as  a  voltage  spike  in  excess  of 
1000  volts. 
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Figure  4.6   Center  Point  Trajectory  with  Commutation 
Reversal  Delay  of  500  /xsec 


65 


Figures  4 . 4  and  4 . 6  depict  much  more  acceptable 
response  behavior  when  a  500/isec  delay  is  provided.  The 
exponential  decay  of  motor  current  shown  in  Figure  4.4  is 
much  slower,  however,  and  does  not  completely  dissipate  the 
coil  energy.  A  voltage  spike  of  160  volts  is  observed  in 
Figure  4.6  and  corresponds  to  the  rapid  dissipation  of 
remaining  coil  energy.  Complete  dissipation  of  the  Stored 
coil  energy  is  apparently  not  practical,  particularly  at 
high  rotational  rates,  due  to  relatively  long  decay  time 
requirements.  However,  voltage  transients  during  braking 
are  minimized  by  nearly  an  order  of  magnitude  using  a  delay 
time  of  500/isec. 

In  general,  highly  responsive  position  control  of  a 
brushless  dc  motor  is  attained  at  the  expense  of  its 
electrical  transient  behavior.  Specifically,  the  level  of 
energy  stored  in  an  inductive  coil  immediately  prior  to 
braking  determines  the  extent  of  its  transient.  Extremely 
stiff  controllers,  such  as  an  ideal  relay,  provide  maximum 
electromotive  force  to  the  motor  at  all  times  during 
positioning.  Figures  4.7  and  4.9  illustrate  the 
unacceptable  transient  current  and  voltage  behavior 
associated  with  the  unbuffered  bang-bang  response.  Figure 
4.7  indicates  a  rapid  transient  behavior  of  plugged  phase 
current  which  results  in  the  1000  volt  spike  shown  in 
Figure  4.9.  The  inclusion  of  a  ±2°  dead  zone  invokes 
generator  action  whose  effects  are  described  in  Figures  4.8 
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and  4.10.  The  relatively  large  window  provided  for  system 
relaxation  by  ±2°  dead  zone  is  clearly  depicted  in  Figure 
4.8,  with  current  characterized  by  the  dominant  effects  of 
back  emf  and  dissipating  coil  energy.  Figure  4.10  indicates 
a  corresponding  voltage  spike  of  only  150  volts  was 
induced.  A  finite  amount  of  stored  coil  energy  was 
converted  to  mechanical  energy  during  motor  relaxation 
provided  by  controller  dead  zone.  However,  system  accuracy 
is  sacrificed  when  dead  zone  is  applied  and  the  duration  of 
natural  system  response  required  to  significantly  reduce 
the  high  voltage  transients  is  unacceptably  large. 
Additionally,  a  fixed  dead  zone  which  is  effective  at  lower 
speeds,  may  not  provide  sufficient  system  relaxation  at 
greater  rotational  rates  where  less  time  is  required  to 
transit  the  dead  zone.  Figure  4.10  shows  an  increased 
voltage  spike  magnitude  of  300  volts  associated  with  a 
higher  speed  reversal.  While  dead  zone  can  be  used  to 
reduce  voltage  transients,  it  is  not  solely  sufficient  to 
ensure  acceptable  behavior. 
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Figure  4.8   Motor  Current  Response  with  2°  of  Dead  Zone 


68 


CENTER  POINT  CLOSED  LOOP  TRflJECTORT 
IDERL  RELflT  CONTROLLER  WITH  NO  DEAD  ZONE 


CO 


O 


R 


0.000  0.017  0.033  0.0S0 

TIME   (seconds)       ilO 


-i 1 

0.087  0.083 

I 


O.IOO 


Figure   4.9      Center  Point  Trajectory  with  No   Dead   Zone 
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Figure  4.10   Center  Point  Trajectory  with  2°  of  Dead  Zone 
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It  has  been  shown  in  this  chapter  that  high  performance 
position  control  of  brushless  dc  motors  is  generally- 
attained  at  the  expense  of  its  power  conditioning 
electronic  component  reliability.  In  support  of  the  need 
for  responsive  fin  actuation,  reasonable  steady  state 
accuracy  and  buffered  electrical  transient  behavior,  pulse 
width- modulation  is  examined  in  Chapter  V.  ~ 
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V.  PULSE  WIDTH  MODULATION 

A.   BACKGROUND 

Two  distinct  categories  of  error  signal  amplifiers, 
linear  and  nonlinear,  are  available  for  this  application. 
The  di-f ference  between  the  two  lies  primarily  in  the  manner 
in  which  they  drive  the  solid  state  devices  of  the  power 
conditioner.  Linear  servo-amplifiers  drive  bipolar 
transistors  in  their  active  regions  and  permit  continuous 
voltage  regulation,  while  nonlinear  servo-amplifiers 
maintain  transistor  operation  in  either  saturation  or 
cutoff.  Pulse  width  modulation  (PWM)  is  one  method  of 
providing  nonlinear  servo-amplifier  control  of  a  brushless 
dc  motor  and  is  the  focus  of  discussion  in  this  chapter. 

While  linear  servo-amplifier  circuits  are  relatively 
simple  and  essentially  free  of  electrical  noise,  they  are 
subject  to  thermal  damage  [Ref.8].  The  fact  that  these 
amplifiers  drive  bipolar  transistors  in  their  linear  region 
explains  the  substantial  amount  of  power  dissipation  into 
heat  that  takes  place  in  the  commutation  switching 
electronics.  Space  constraints  in  the  cruise  missile  fin 
actuator  application  preclude  the  use  of  large  heat  sinking 
elements  necessary  to  protect  solid  state  components  from 
thermal  damage.  Conversely,  pulse  width  modulated 
amplification   is   characterized   by   negligible   power 
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dissipation  into  heat.  Although  two  state  transistor 
operation  is  thermally  advantageous,  it  is  a  source  of 
increased  electrical  noise  due  to  switching.  Fortunately, 
PWM  is  negligibly  influenced  by  noise  since  the  random 
variation  of  amplitude  has  little  effect  on  the  information 
contained  in  the  pulse  width  modulated  signal. 
Additionally,  the  extent  of  current  ripple  and  subharmonic 
oscillation  due  to  the  periodic  output  of  the  pulse  width 
modulator  is  insignificant  [Ref.6].  Since  the  power 
transistors  are  switched  on  and  off  at  a  frequency  far 
exceeding  the  motor's  bandwidth,  the  majority  of  the  high 
frequency  component  of  the  modulated  signal  is  filtered  by 
the  motor. 

Pulse  width  modulation  is  a  technique  for  regulating 
the  amount  of  energy  supplied  to  the  motor  for  development 
of  torque.  Effective  regulation  is  accomplished  by 
modulating  a  fixed  voltage  amplitude  on  a  reference 
frequency  and  linearly  scaling  its  pulse  duty  cycle. 

B.   DESCRIPTION 

The  PWM  scheme  modeled  in  this  study  behaves  similarly 
to  the  Dither  Method  outlined  by  Askinas  [Ref.6]  and  is 
illustrated  in  Figure  5.1.  A  reference  sawtooth  waveform 
of  desired  frequency  and  amplitude  is  generated  through 
independent  circuitry  and  is  differenced  with  the  closed 
loop  system's  amplified  position  error  signal . 
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Figure  5 . 1   Pulse  Width  Modulation  Functional  Model 

The  amplifier  is  comprised  of  linear  and  nonlinear 
regions  of  operation.  Nonlinear  gain,  denoted  as  "Kp^"  in 
the  computer  simulations  appended,  is  applied  as  saturation 
amplification  to  the  error  signal.  Relay  elements  are  used 
to  convert  the  bias  of  the  summed  signal  to  a  tri-state 
logic  output  which  is  summarized  in  Figure  5.1.  Because 
the  polarity  of  the  source  voltage  is  fixed,  directional 
rotation  is  accomplished  using  separate  commutation 
sequences  as  shown  in  Table  I.  "DIR"  is  the  variable  used 
to  indicate  commutation  direction  in  the  simulation  and  is 
assigned  a  value  of  +1  for  clockwise  rotation  and  -1  for 
counterclockwise   rotation.     With   "DIR"   accounting   for 
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directional  convention,  forcing  potential  (VIN)  is 
controlled  by  two-state  logic.  When  PWM  logic  triggers  the 
application  of  150V  supply  voltage  to  the  motor  and 
determines  the  commutation  sequencing  logic  requested  by 
the  controller,  powering  conditions  remain  fixed  for  the 
remainder  of  the  reference  period. 

Figure  5.2  illustrates  the  convenient  one-to-one 
relationship  between  the  nonlinearly  amplified  error  signal 
(|E|)  and  the  duty  cycle  of  the  pulsed  output  (PULSE).  Due 
to  the  saturation  amplification  of  the  system  error 
(POSERR)  ,  |E|  is  bounded  within  the  range  from  zero  to 
unity. 


THRESH 
(l-IEl)N 


PULSE 


3T  TIME 


Figure  5.2   Relationship  Between  |E|  and  Pulse  Duty  Cycle 
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THRESH  describes  the  biased  error,  and  is  given  by 
Equation  5.1.  When  THRESH  is  less  than  the  reference 
sawtooth  signal  during  each  cycle,  VIN  is  pulsed  on  by  the 
PULSE  signal. 

THRESH  =  1  -  |E|  (5.1) 

The  linear  nature  of  the  reference  sawtooth  signal  over 
each  pulsing  period  results  in  linear  scaling  of  pulse  duty 
cycles  when  the  error  is  in  the  range  {  0  <  |E|  <  1  }.  The 
relationship  observed  in  Figures  5.1  and  5.2  between  E  and 
the  duty  cycle  of  VIN  is  given  by  Equation  5.2. 

Duty  Cycle  of  VIN  =  |e|*T  (5.2) 

Figures  5.3  through  5.8  are  examples  of  open  loop 
transfer  characteristics  of  the  pulse  width  modulator 
modeled  in  this  study.  Pulse  width  modulation  of  ramp  and 
sinusoidal  (undamped  and  exponentially  decaying)  error 
signals  are  examined  with  varying  amplifier  gain  and  dead 
zone  to  illustrate  its  properties.  Open  loop  PWM  transfer 
characteristics  are  ascertained  using  the  simulation  listed 
in  Appendix  B.  Figure  5.3  depicts  the  linear  scaling  range 
of  the  PWM  amplifier  for  a  specific  gain.  In  this  case, 
KPWM  (9a^-n)  equals  0.5  and,  when  applied  to  the  continuous 
input  ramp  error  signal,  results  in  an  increased  range  of 
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modulation  for  the  directional  logic  signal.  Figure  5.4 
illustrates  the  effect  of  increased  amplifier  gain  as  well 
as  the  inclusion  of  a  controller  dead  zone.  For  an 
identical  ramp  error  signal  input,  the  increased  gain 
results  in  a  reduced  linear  region  of  modulation.  Dead 
zone  is  observed  in  Figure  5.4  near  the  zero-crossing  of 
the  i'nput  error  signal  (t=2. 5msec)  and  is  characterized  by 
a  corresponding  Directional  Logic  level  of  0.  Therefore, 
the  use  of  dead  zone  in  the  PWM  amplifier  buffers  the 
effects  of  switching  when  the  error  signal  changes 
polarity.  Figure  5.5  illustrates  the  pulse  width 
modulation  of  an  undamped  sinusoidal  error  signal  with  low 
amplifier  gain  and  no  dead  zone.  The  sinusoidal  waveform 
is  reasonably  well  preserved,  but  would  be  much  improved 
with  a  higher  sampling  frequency.  Modulation  of  the  same 
sinusoid  at  a  higher  gain  and  with  dead  zone  is  shown  in 
Figure  5.6.  Very  little  width  modulation  takes  place  when 
gain  is  high  due  to  saturation  effects  and  causes  VIN  to 
resemble  the  output  characteristics  of  a  relay  with  dead 
zone.  The  pulse  width  modulation  of  relatively  large  scale 
sinusoidal  error  inputs  is  examined  in  Figures  5.5  and  5.6. 
In  position  control  application,  however,  error  amplitudes 
associated  with  stable  systems  tend  to  decrease  with  time. 
Additionally,  larger  amplifier  gains  for  this  Type  1  system 
provide  improved  steady  state  accuracy  and  is  further 
discussed   in   Chapter   VI.     The   exponentially   decaying 
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sinusoid  used  as  an  input  error  signal  in  Figures  5.7  and 
5.8  presents  a  more  realistic  representation  of  the  range 
of  inputs  to  be  encountered.  The  low  gain  configuration 
illustrated  in  Figure  5.7  results  in  linear  modulation  of 
the  waveform  over  the  range  examined  and  is  characterized 
by  the  Directional  Logic  signal  pulse  width  being 
proportional  to  the  input  error  signal  amplitude.  The 
pulse  width  characteristically  decreases  with  the 
exponentrially  decaying  magnitude  of  the  input. 
Conversely,  the  modulation  using  high  gain  with  the  same 
input  is  shown  in  Figure  5.8  and  results  in  saturation  of 
the  output  pulse  as  shown  by  fixed  pulse  width  during 
periods  of  relatively  large  input  magnitude. 

C.   PARAMETER  SELECTION 

Time  averaging  provided  by  low  pass  characteristics  of 
the  _brushless  dc  motor  smooth  the  effects  of  the 
discontinuous  pulse  width  modulated  forcing  function.  The 
PWM  may  be  analytically  treated  as  a  piecewise  continuous 
function  if  specific  approximation  criteria  are  satisfied. 
Validity  of  such  an  approximation  is  principally  determined 
by  the  reference  sawtooth  frequency  of  the  PWM.  Lumped 
parameter  analysis  of  this  typical  motor  used  in  this  study 
reveals  an  average  mechanical  time  constant,  rM,  of  0.1 
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Figure  5.3   PWM  Open  Loop  Transfer  Characteristics 
(Linear  Input,  Low  Gain,  No  Dead  Zone) 
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Figure  5.4   PWM  Open  Loop  Transfer  Characteristics 
(Linear  Input,  High  Gain,  .1°  Dead  Zone) 
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Figure  5.5   PWM  Open  Loop  Transfer  Characteristics 
(Sinusoidal  Input,  Low  Gain,  No  Dead  Zone) 
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Figure  5.6   PWM  Open  Loop  Transfer  Characteristics 
(Sinusoidal  Input,  High  Gain,  .1°  Dead  Zone) 
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Figure  5.7   PWM  Open  Loop  Transfer  Characteristics 
(Damped  Sinusoidal  Input,  Low  Gain,  No  Dead  Zone) 
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Figure  5.8   PWM  Open  Loop  Transfer  Characteristics 
(Damped  Sinusoidal  Input,  High  Gain,  .1°  Dead  Zone) 
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seconds  and  an  electrical  time  constant,  rE,  of  .000165 
seconds.  Despite  the  dominant  low  pass  characteristics  of 
the  slow  mechanical  time  constant,  empirical  derivation 
based  on  computed  results  indicates  the  pulse  width 
modulation  reference  sawtooth  frequency  should  be  at  least 
lOKHz.  At  such  frequencies,  the  motor  effectively  smoothes 
the  pulsed  forcing  action  of  the  PWM.  Phase  plane  methods 
discussed  in  Chapter  VI  are  used  to  graphically  illustrate 
the  effects  of  pulse  frequency  on  system  response.  System 
simulations  using  lower  sawtooth  waveform  frequencies 
indicate  stable  but  very  oscillatory  response  behavior.  It 
is  recognized  that  solid  state  power  switching 
characteristics  pose  a  limitation  on  the  maximum  realizable 
PWM  reference  frequency.  Therefore,  a  lOKHz  pulse 
frequency  is  selected  on  the  basis  of  response  smoothing 
and  hardware  constraints. 

The  selection  of  simulation  step  size  is  largely 
dependent  upon  the  reference  sawtooth  waveform  frequency. 
The  Nyquist  rate  determines  the  minimum  sampling  frequency 
required  to  reconstruct  the  assumed  bandlimited  sawtooth 
waveform.  If  the  step  size  is  chosen  less  than  one-half  of 
the  reciprocal  of  the  hiqhest  significant  frequency 
component  (fc)  °f  tne  sawtooth  waveform's  Fourier 
transform,   then   aliasing   will   be   avoided   [Ref.10]. 
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Equations  5.3  and  5.4  determine  the  Nyquist  sampling  period 
(T_)  of  a  periodic  sawtooth  waveform  of  period  Tp  and 
amplitude  EM. 


Jo 


H(f)  =  fTP  EM  te-^'/t  dt  (5.3) 

TP 


Ts  =  l/(2fc)  =  50  /isec  (5.4) 

However,  simulation  based  on  the  Nyquist  rate  is 
observed  to  be  inadequate  and  does  not  provide  accurate 
pulse  width  modulation  of  error  signals.  The  full  range  of 
the  sawtooth  response  (0<VREF<1)  must  be  reconstructed  in 
the  simulation  to  support  modulation  of  small  amplitude 
error  signals.  Observation  of  computed  results  indicates 
that  a  minimum  simulation  step  size  of  an  order  of 
magnitude  less  than  the  PWM  pulse  period  is  required  for 
accurate  simulation. 

PWM  amplifier  gain  determines  the  region  of  pseudo 
linear  operation.  Consequently,  large  gains  result  in  hard 
response  characteristics  near  steady  state,  while  low  gains 
allow  soft  behavior.  The  interaction  of  PWM  frequency  and 
gain  may  result  in  unacceptable  residual  oscillations  and 
ballistic  overshoot  conditions.  This  self  excited 
oscillation,  or  limit  cycle,  is  commonly  associated  with 
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nonlinear  servo-amplifier  control  and  will  be  studied  more 
completely  in  Chapter  VI  using  phase  plane  methods. 
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VI.  PRELIMINARY  PHASE  PLANE  DESIGN 

A.   BACKGROUND 

The  highly  nonlinear  and  discontinuous  nature  of  a 
pulse  width  modulated  position  controller  precludes  the  use 
of  most  classical  stability  analysis  methods.  Computer 
simulation  lends  itself  well  to  simple  time  response 
analysis,  but  restriction  to  such  a  method  often  masks  many 
of  the  underlying  characteristics  which  determine  a 
system's  general  behavior.  Nonlinear  controllers  are  most 
often  analyzed  with  either  describing  function  or  phase 
plane  techniques.  The  describing  function  is  a  frequency 
response  method  which  ultimately  determines  transfer 
function  characteristics  of  the  control  system.  However, 
the  discontinuous  nature  of  pulse  width  modulation  limits 
the  effectiveness  of  the  describing  function.  Phase  plane 
methods,  on  the  other  hand,  are  well  suited  to  handle  the 
PWM  stability  problem  provided  that  a  second  order  model  is 
applicable  and  the  methods  are  complemented  by  numerical 
simulation  of  the  time  response  of  state  trajectories. 

The  underlying  premise  of  analyzing  a  second  order 
system  in  the  phase  plane  is  that  linear  and  nonlinear 
components  of  its  characteristic  differential  equation  can 
be  partitioned.    Consider  the  general  form  of  a  second 
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order  differential  equation  describing  the  response  of  e(t) 
and  given  by  Equation  6.1. 

*e  +  f(e,e)  =  0  (6.1) 

The  term  f(e,e)  is  a  nonlinear  function  of  e(t)  and 
e(t)  when  equation  6.1  describes  the  fin  actuator's 
performance.  Rather  than  studying  e(t)  and  e(t) 
parametrically ,  the  composite  function  e(e(t))  can  be 
determined  and  studied  graphically.  The  phase  plane 
portrait  of  e(t)  versus  e(t)  bears  a  wealth  of  information 
describing  a  system's  dynamics  which  is  otherwise  lost  in 
parametric  analysis  of  the  time  solutions. 

The  intent  of  this  chapter  is  to  develop  the  phase 
plane  method  of  analysis  as  a  primary  tool  for  studying  the 
dynamics  associated  with  position  control  of  brushless  dc 
motors.  Additionally,  preliminary  values  for  design 
parameters  will  be  determined  based  on  system  performance 
criteria. 

B.   LINEAR  APPROXIMATION 

State  space  methods  associated  with  phase  plane 
portrait  development  are  not  well  suited  for  analysis  of 
the  detailed  brushless  dc  motor  model.  Such  an  approach 
involves  the  use  of  a  third  order  model  with  very  stiff 
dynamics  and  would  be  computationally  cumbersome  and 
inefficient.      However,    the   detailed   model   may   be 
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approximated  by  the  linear  lumped  parameter  third  order 
model  shown  in  Figure  6.1.  Average  system  parameters  for 
the  typical  motor  used  in  this  study  are  given  in  Table  II. 
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Figure  6.1   Third  Order  Lumped  Parameter  Model 


TABLE  II 


AVERAGE  SYSTEM  PARAMETERS 


Viscous  Friction 
Motor  Inertia 
Equiv  Resistance 
Eguiv  Inductance 
Torque  Constant 
Back  EMF  Constant 


f 

J 

R 

L 

Kr 

K 


B 


.01  [oz-in/secl 

.001  [oz-in/sec2] 

9.7  [ohms] 

.0016  [henries] 

15.9  [oz-in/amp] 

.112  [volts/rad/sec] 


The  lumped  parameter  model's  validity  as  an  acceptable 
representation  of  the  3-phase,  4-pole  brushless  dc  motor 
may  be  demonstrated  using  analytic  and  computer  simulation 
methods.   The  closed  loop  transfer  function  describing  the 
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block  structure  of  Figure  6.1  for  Q(s)/Ea(s)  is  given  by 
Equation  6.2. 


Qfs)   =  KT (6.2) 

Ea(s)      (R  +  sL)  (f  +  sJ)  +  KTKB 


For  a  step  input  magnitude  of  Ea  =  150v,  steady  state 
output  can  be  obtained  using  the  final  value  theorem.  The 
steady  state  velocity  (^ss)  is  determined  in  Equation  6.3. 


u> 


=  Ea_KT =  1270  rad/sec  (6.3) 

£R   "+■   KrpKrj 


Assuming  a  10:1  mechanical  transmission  speed 
reduction,  velocity  may  be  converted  from  rad/sec  to  fin- 
deg/sec. 


wfss=(1270  rad) (57.3  deg) ( 0 . 1) =7277  fin-deg 
sec       rad  sec 


Motor  current  is  also  of  interest  in  the  verification 
of  the  averaged  parameter  model  and  the  transfer  function 
I(s)/Ea(s)  is  given  by  Equation  6.4. 


I(s)  =  f  +sJ (6.4) 

Ea(s)    (R+sL)  (f+sJ)  +  KTKB 
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Again,  using  a  step  input  of  magnitude  Ea  =  150v, 
steady  state  current  is  obtained  using  the  final  value 
theorem  and  is  calculated  in  Equation  6.5. 


Iss  =  Ea  f    =0.79  amps  (6.5) 

f  R   T   Km  K  p 


Velocity  and  current  response  characteristics  of  both  the 
third  order  lumped  parameter  model  and  the  detailed 
brushless  dc  motor  model  are  simulated  using  programs 
listed  in  Appendices  A  and  C,  respectively,  and  the  results 
for  fin  velocity  and  current  response  are  illustrated  in 
Figures  6.2  through  6.5.  Simulated  response 
characteristics  support  analytically  determined  steady 
state  behavior  of  the  third  order  lumped  parameter  model . 
The  ripple  component  in  the  motor  current  caused  by  back 
emf  generation  in  the  brushless  dc  motor  constitutes  the 
principal  difference  in  performance  between  the  two  models. 
General  performance  similitude  indicates  the  brushless  dc 
motor  may  be  accurately  represented  with  respect  to  its 
mechanical  and  electrical  response  using  an  averaged 
parameter  model . 

Although  phase  space  methods  support  solution  of  third 
order  systems,  the  extra  simulation  time  and  programming 
effort  involved  do  not  justify  inclusion  of  a  third 
dimension  in  the  portrait  of  this  system.   The  electrical 
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Figure  6.2   Brushless  DC  Motor  Fin  Velocity  Step  Response 
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and  mechanical  time  constants  of  the  motor  are  determined 
by  Equations  6.6  and  6.7. 


r£  =  L  =  .0016  h  =  .000165  sec 
R      9.70 


(6.6) 


rM  =  1   = 


♦001  foz-in/s-)  =0.1  sec 
.01  (oz-in/s) 


(6.7) 


Clearly,  the  mechanical  time  constant  dominates  general 
system  response  and  results  in  low  pass  behavior. 
Neglecting  the  fast  time  constant,  that  is,  assuming  no 
circuit  inductance,  the  system  performance  should  remain 
virtually  unchanged.  This  reduced  order  model  is  shown  in 
Figure  6.6  and  can  be  verified  as  a  legitimate  substitute 
for  the  third  order  model. 
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Figure  6.6   Reduced  Order  Lumped  Parameter  Model 
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Equation  6.8  gives  the  closed  loop  transfer  function 
relationship  describing  the  reduced  order  model. 


Q(s)  =  KT/JR  (6.8) 

E_(S)    S  +  fR  +  KTKp 

a        ~Jr~"t~b 


The  final  value  theorem  is  used  to  determine  the  steady 
state  velocity  when  a  step  amplitude  Ea  =  150v  is  applied. 


W 


=   KT  E-,   =  1270  rad  -  w_=7277  fin-deq    (6.9) 


ss    -rT— a-    —  •-  -~~    ~ss 

fR+KmKB        sec  sec 


The  motor  current  response  start-up  performance  is 
significantly  affected  by  the  removal  of  circuit  inductance 
and  its  associated  lag,  but  retains  similar  steady  state 
characteristics  as  determined  by  Equations  6.10  and  6.11 
and  illustrated  in  Figures  6.7  and  6.8. 


I(s)  =  f  +sJ (6.10) 

Ea(s)    R  (f+sJ)  +  KpKg 


Iss  =  Ea_f =0.79  amps  (6.11) 

TR  T   KrpKo 


Table  III  summarizes  performance  characteristics  of  the 
detailed  model  of  the  brushless  dc  motor,  its  third  order 
linear  approximation,  and  the  reduced  order  model. 
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Figure  6.7   Reduced  Order  Model  Fin  Velocity  Step  Response 
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Correlation  is  very  strong  between  the  detailed  and  reduced 
order  models,  substantiating  its  use. 


TABLE  III 
LINEAR  APPROXIMATION  VALIDATION 


Qss 


I__  [amps] 


ss 


Brushless 
DC  Motor 

Third  Order 
Approximation 

Reduced  Order 
Approximation 

7670 

7277 

7277 

1.4  (avg)t 

0.79 

0.79 

.0275 

.0225 

.0225 

14.59 

14.20 

15.5 

.0145 

.0118 

.0120 

Wtle  Esecl 
(±  2%) 

Ipeak  tamPs] 
trise  Csec] 

(IOf-90%) 


C .   DEVELOPMENT 

The  computer  aided  phase  plane  program  developed  for 
analyzing  this  system  is  listed  in  Appendix  D  and 
graphically  superpositions  the  simulated  time  dependent 
trajectory  and  the  state  space  solutions  for  a  sufficiently 
representative  region  of  values  of  e  and  e.  The 
analytically  determined  state  space  solutions  are 
illustrated  as  slope  markers  which  indicate  the 
instantaneous  slopes  of  e(e(t))  at  any  condition  (e,e).  If 
the   range   of   e   and   e   to   be   examined   is   reasonably 

T  Steady  state  conditions  not  reached  at  t  =  0.3  sec.   Extended 
simulation  reveals  I   (t=0.05  sec)  -»  1 . 1  amp. 
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representative  of  the  normal  operating  conditions  of  the 
system,  stability  may  be  validated  by  the  exclusion  of  any 
singular  points,  areas  of  local  convergence,  or  areas  of 
divergence.  The  criterion  for  stability  in  this  design  is 
absolute  convergence  to  a  stable  equilibrium  point 
representing  steady  state  conditions  or,  as  is  common  in 
many  nonlinear  systems,  convergence  to  a  limit  cycle  about 
steady  state. 

A  limit  cycle  is  an  isolated  closed  path  or  trajectory 
in  the  phase  plane  and  describes  a  system's  self-excited 
oscillation  [Ref.ll].  If  the  limit  cycle  is  unstable,  the 
closed  loop  path  constitutes  the  boundary  between  stable 
and  unstable  regions.  For  a  stable  limit  cycle, 
trajectories  outside  and  in  the  vicinity  of  a  stable  limit 
cycle  will  converge  to  it,  while  those  trajectories  inside 
will  diverge  to  the  limit  cycle.  Limit  cycle  behavior  is 
anticipated  in  pulse  width  modulated  position  control  of 
the  brushless  dc  motor  due  to  inherent  time  delay  in 
switching  and  is  further  investigated  in  this  chapter. 

A  simulated  trajectory  represents  actual  system 
performance  over  time  when  specific  initial  conditions  are 
imposed.  While  the  trajectory  offers  tremendous  insight 
into  the  system's  dynamics  for  specific  response 
conditions,  the  unique  value  of  phase  plane  analysis  lies 
in  the  general  state  space  solution  presented  in  the  phase 
plane  portrait.    Figure  6.9  illustrates  the  reduced  order 
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model  configured  for  closed  loop  fin  position  control.  The 
block  structure  is  expanded  to  identify  necessary  states  of 
the  second  order  system. 
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Figure  6.9   Closed  Loop  Reduced  Order  Model  State  Diagram 

The  system's  state  equations  are  developed  for  the 
purpose  of  defining  instantaneous  slope  vectors  (rj)  as 
functions  of  error  (e)  and  error  rate  (e) . 


n   =  f(e,e)  =  d  eft) 
d  e(t) 


(6.12) 
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Fin  position  (^fIN^  -*-n  de9rees  is  assigned  the  state 

variable  x-,.   Its  derivative  state  (wpIN)  in  fin-deg/sec  is 
x2. 

X-j_  =  x2  (6.13) 

To   describe  higher   order   state   variables,   it   is 
necessary  to   introduce  and  apply  a  scalar  transmission 

factor  (Q°)  which  converts  units  from  Motor  Radians  to  Fin 
Degrees. 


Q°    =   n  180°  (6.14) 

7T 


The  variable  "n"  of  Equation  6.14  is  the  motor  to  fin 
mechanical  transmission  gear  ratio  and  is  assumed  to  be  0.1 
in  this  study.   Angular  acceleration  of  the  fin  in  deg/sec 
is  given  by  Equation  6.15. 


x2  =  Q°  Kp  VIN(e.e)  -  (KTKp  +  fR)  x2  (6.15) 

JR 


Closed  loop  system  error  (e)  is  defined  via  position 
and  velocity  feedback  circuits  and  is  given  by  Equation 
6.16.  The  dynamic  nature  of  the  missile  guidance  and 
flight  control  result  in  the  fin  controller  behaving  more 
as  a  position  tracking  vice  positioning  device.  Therefore, 
while  step  response  analysis  is  important  to  determine  the 
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general  behavior  of  the  motor,  it  is  solely  inadequate  to 
characterize  the  overall  behavior  of  the  system.  Ramp 
response  analysis  more  completely  describes  the  motor's 
dynamic  positioning  performance.  Using  the  phase  plane 
simulation  developed  for  this  study,  a  ramp  input  whose 
time  dependence  is  scaled  by  its  slope  (r)  is  used  to 
evaluate  system  tracking  performance.  Step  response 
analysis  is  performed  by  describing  initial  perturbation 
conditions  (e(0),e(0))  and  zeroing  the  ramp  slope. 

e  =  r  t  -  Kp  X2  (6.16) 

Differentiating  Equation  6.16  yields  the  system's  error 
rate,  e. 

e  =  r  -  Kp  x2  (6.17) 

Manipulation  of  these  equations  of  state  is  required  to 
determine  expressions  for  x2  and  x2  solely  in  terms  of  e 
and  e.   Equations  6.17  may  be  rewritten  as  Equation  6.18. 


x2  =  r  -  e  (6.18) 

Kp 


Substitution  of  Equation  6.18  into  6.15  yields  Equation 
6.19. 
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x2  =  n°  KTKr  VINfe.e)  -  (KmKD+fR) (r-e)  (6.19) 

JR  Kp 


Finally,  the  instantaneous  slope  function  (r?)  is  given 
by  Equation  6.20,  and  is  composed  of  natural  and  forced 
components. 


r]   =  f(e,e)  =  d  eft)  =  -  _Kp_j£2  =  "  KP  ^2^® 
d  e(t)       r-KpX2 


n   =   -n°  KjKp  VINfe.e)  ±    (e'-r)  (KjKp+fR)         (6.20) 

JR  e 


The  slope  function  (r;)  is  linear  in  terms  of  e  and  e, 
except  for  the  VIN(e,e)  term.  The  nonlinearity  arises  from 
transfer  function  characteristics  of  the  pulse  width 
modulator.  Because  of  the  distinct  segregation  of  linear 
and  nonlinear  elements,  however,  the  model  may  be 
approximated  as  a  piecewise  linear  system.  The  phase  plane 
is  subdivided  into  several  regions  whose  commonalty  is 
local  linear  operation.  These  regions  are  graphically 
bounded  by  lines  of  discontinuity  on  the  phase  plane 
portrait.  Table  IV  describes  the  five  piecewise  continuous 
regions  of  operation  associated  with  saturation  amplifier 
and  PWM  servo  control.  The  use  of  relay  control  involves 
regions  1,  4,  and  5  only. 
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TABLE  IV 
PIECEWISE  CONTINUOUS  APPROXIMATION 


Error 
Reaion#   Condition   VIN(e.e)  Slope 

1      |P1|<DBAND      0  (KpKp+fR)  fr-e) 

(Dead'  JRe 

Zone) 

.  .  .where   P-^  =  e+eKv+ess 

Kp 


2  0<P2<1  150P2         -( fl50P)n°KrKr+ff-e) (KjKp+fR) I 

(Positive  JRe 

Linear) 

...where        P2   =  KpwM(e+eKv-DBAND-ess) 

Kp 


3      -1<P3<0       150P3    -(  (150P)Q°KTKp+f<r-e)  (KTKp+fR)  } 
(Negative  JRe 

Linear) 

...where    P3  =  KpwM(e+eKv+DBAND-ess) 

K« 


4  P4>1  150P4         -(  ri50)0oKTKr+fr-e^  (KjKp+fR)  ) 

(Positive  JRe 

Saturation) 

...where        P4   =  KpwM(e+eKv-DBAND-ess) 

Kr> 


5        ^5^-1       150P5    -(  fl50)QoKTKr-Kr-e)  fKTKD+fR)  ) 
(Negative  JRe 

Saturation) 

...where    P5  =  KpWM(e+eKv+DBAND-ess) 

Kt> 
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Excluding  dead  zone  error,  the  steady  state  error,  ess, 
of  this  Type  1  system  is  of  finite  value  for  ramp  response 
and  zero  when  stepped.  ess  is  determined  by  Equation  6.21 
and  permits  correct  ramp  response  prediction  using  state 
space  solution  techniques. 


Ky  =  lim  s  r  rfs)  1 
s^O   l+G(s)H(s) 


e   =  r  =   rf fR+KjKp)  +  r_Kv  +  Dead  Zone     (6.21) 
Y^        O'KpKpK^vTN     Kp 


Ka  is  the  amplifier  gain  associated  with  the  nonlinear 
controller.  kpwm'  as  defined  i-n  Chapter  V,  is  substituted 
for  Ka  when  pulse  width  modulation  is  employed. 

Interpretation  of  Equation  6.21  describes  the  effects 
of  amplifier  gain  on  ess.  If  Ka  is  infinitely  large,  such 
as  in~the  case  of  an  ideal  relay,  the  steady  state  error  is 
minimized  and  is  approximated  by  Equation  6.22. 


ess (relay)  =  r  K. .  +  Dead  Zone  (6.22) 


However,  as  Ka  is  reduced,  the  first  term  of  Equation 
6.21  bears  more  significance  and  the  steady  state  error  is 
increased.  Thus,  system  accuracy  is  readily  ascertained 
using  analytical  methods  and  is  presented  for  comparison 
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with  the  simulated  trajectory  as  an  asterisk  ("*")  on  the 
phase  plane  portrait. 

As  discussed  previously,  the  output  of  the  PWM  is 
either  0  or  150v.  However,  the  pulse  duration  is  a 
nonlinear  function  of  error.  Since  the  pulse  width 
modulator  is  described  in  terms  of  e  and  e,  as  well  as  by 
time,--  difficulty  exists  in  trying  to  illustrate  "three 
dimensional  characteristics  on  a  two  dimensional  phase 
plane.  However,  the  nonlinear  dependency  on  time  may  be 
alleviated  through  linear  approximation  methods.  This  is 
accomplished  by  time  averaging  the  response  of  the  PWM. 
The  result  of  such  a  linearization  closely  approximates  the 
characteristics  of  a  saturating  amplifier.  Specifically, 
the  function  which  describes  the  average  output  of  these 
two  nonlinear  elements  is  the  same.  The  average  dc  voltage 
of  the  PWM  is  defined  by  Equation  6.23. 


I  f  T  V 
T  J  0 


VDC  =1   x  VQUt  dt=Pulse  Duty  Cycle*150v     (6.23) 


The  variable  "T"  represents  the  period  of  the  PWM's 
pulse  cycle. 

The  instantaneous  error  of  the  system  is  nonlinearly 
scaled  by  the  PWM  amplifier  gain  (KpwM)  and  was  discussed 
in  detail  in  Chapter  V  where  essentially,  error  undergoes 
normalized  saturation  amplification.   The  normalized  value 
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of  amplified  error  is  the  same  as  the  pulsed  voltage  output 
duty  cycle  of  the  PWM. 

This  one-to-one  relationship  between  input  error  and 
output  voltage  circumvents  the  otherwise  required 
dependency  on  the  time  variable  to  describe  pulse  duration. 
The  phase  plane  portrait  of  a  saturating  amplifier  will  be 
used  to  predict  the  simulated  trajectory  of  the  pulse  width 
modulated  reduced  order  model.  It  must  be  kept  in  mind, 
however,  that  while  the  piecewise  continuous  saturating 
amplifier  provides  a  good  average  approximation  of  the 
PWM's  discontinuous  characteristics,  instantaneous 
deviations  will  exist. 

D.   SYSTEM  PERFORMANCE 

Four  principal  design  parameters  are  realistically 
available  for  optimizing  system  performance.  The  lumped 
parameters  of  the  reduced  order  model  preclude  variation  of 
actual  component  characteristics  of  the  brushless  dc  motor. 
Coefficients  for  position  and  velocity  feedback  (K_  and 
Ky)  ,  pulse  width  modulation  amplifier  gain  (KpwM) ,  and  PWM 
pulse  frequency  (fpyftj)  are  considered  free  parameters  in 
this  design  and  are  the  focus  of  study  in  this  section. 

Since  the  pulse  width  modulator's  performance  can  be 
most  clearly  evaluated  relative  to  ideal  conditions, 
analysis  of  the  system  using  a  similarly  configured 
saturating   amplifier   and   ideal   relay   are   initially 
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considered.  The  continuous  time  saturating  amplifier 
describes  the  PWM  with  very  high  amplifier  gain.  Identical 
simulation  conditions  are  imposed  on  each  system 
configuration.  Small  scale  step  response  is  attained  using 
an  initial  perturbation  of  3°.  The  pulse  width  modulator  is 
configured  with  intentionally  low  values  of  amplifier  gain 
and  pulsing  frequency  to  accentuate  their  effects  on  system 
performance.  For  similar  reasons,  velocity  feedback  is  not 
used  in  this  illustrative  trial.  A  relatively  large  dead 
zone  of  ±0.25°  is  simulated  to  facilitate  observation  of  the 
system's  natural  response.  Phase  plane  characteristics  of 
PWM,  relay,  and  saturating  amplifier  controlled  systems  for 
a  step  input  are  shown  in  Figures  6.10  through  6.12, 
respectively. 

Each  of  the  three  controller  configurations  display 
identical  response  characteristics  in  the  dead  zone  and 
saturation  regions.  This  is  anticipated  since,  in  these 
regions,  all  three  nonlinear  controllers  are  characterized 
by  either  0  or  150  volts  of  continuous  output.  It  is 
interesting  to  note  that  the  PWM  model  is  unaffected  by 
pulsing  frequency  in  these  regions.  This  is  due  to  the 
system  error  being  outside  of  the  linear  range  of 
modulation  and  thus  resulting  in  continuous  modulation  duty 
cycles  of  0  or  100%.  The  linear  region  of  operation  is 
unique  to  the  saturating  amplifier  and  PWM  controlled 
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systems.  Although  the  phase  plane  portraits  representing 
these  two  configurations  are  defined  identically,  the 
relatively  low  pulsing  frequency  exaggerates  the  effects  of 
the  discontinuous  PWM.  Specifically,  the  pulsing  period 
used  in  the  response  of  Figure  6.10  is  sufficiently  large 
so  as  to  cause  undesirably  long  durations  of  forced  and 
natura'l  response  for  a  determined  duty  cycle.  The 
increased  significance  of  the  time  dimension  in  the  phase 
plane  results  in  time  averaging  being  a  less  valid 
approximation  of  actual  performance.  If  the  trajectory  in 
the  linear  region  of  the  PWM  of  Figure  6.10  was  time 
averaged,  it  would  describe  the  same  response  as  the 
saturating  amplifier  shown  in  Figure  6.12.  However,  the 
instantaneous  and  erratic  trajectory  of  Figure  6.10  follows 
the  path  of  the  relay  of  Figure  6.11  while  being  forced 
with  150  volts  and,  during  the  relaxed  mode,  the  path  of 
natural  response  of  the  dead  zone.  Since  the  continuous 
amplifier  provides  ideally  smooth  response  behavior,  a 
maximum  value  of  pulsing  frequency  is  desired.  Frequency 
considerations  are  discussed  in  subsequent  trials. 

The  relative  "softness"  of  the  PWM's  settling  behavior 
is  due  to  its  relatively  low  value  of  amplifier  gain. 
Small  error  values  receive  inadequate  gain  to  provide  the 
stiff   control   typically   desired   in   high   performance 
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applications.    Increasing  amplifier  gain  approximates  the 
stiff  response  of  the  relay  shown  in  Figure  6.11. 

The  first  design  parameter  to  be  independently  examined 
in  the  phase  plane  was  PWM  pulse  frequency.  Although  a 
maximum  pulsing  frequency  of  lOKHz  was  selected  in  Chapter 
V  based  on  hardware  limitations,  the  effect  of  pulse 
duration  on  system  response  is  significant  and  deserves 
attention.  Figures  6.13  through  6.16  illustrate  the 
effects  of  varying  fp^  with  values  of  1,  5,  10,  &  20KHz. 
Amplifier  gain  remains  small  so  as  to  expand  the  linear 
region  where  pulsing  frequency  affects  the  response.  All 
observations  made  during  the  trial  describe  the  simulated 
trajectory  in  the  linear  region  of  operation. 

Figure  6.13  shows  the  unacceptable  consequences  of 
using  an  insufficient  fpwM*  Poor  correlation  between 
portrait  and  trajectory  characteristics  implies  the  invalid 
time  averaging  is  attributed  to  excessive  pulse  duration. 
The  response  is  smoothed  with  higher  pulsing  frequencies. 
However,  the  difference  between  the  10  KHz  and  2  0  KHz 
responses  is  negligible,  indicating  that  very  high 
frequencies  are  not  required  for  the  linear  approximation 
of  continuous  saturation  amplification  to  be  valid. 
Therefore,  10  KHz  was  selected  as  optimum  for  PWM  pulsing 
frequency. 
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Amplifier  gain  determines  to  a  large  extent  the 
system's  responsiveness.  Figures  6.17  through  6.19 
illustrate  system  behavior  ranging  from  "soft"  to  "stiff". 
Relatively  soft  behavior  shown  in  Figure  6.17  is  due  to  the 
use  of  an  amplifier  gain  of  0.1  and  is  characterized  by  a 
slow  oscillatory  transient.  Conversely,  stiff  conditions 
are  shown  in  Figure  6.19  and  are  attained  using  a  Kp^j  of 
10.0.  The  trajectory  resembles  the  response  of  the  relay 
shown  in  Figure  6.11  and  is  described  by  very  rapid 
"chattering"  of  the  motor  about  steady  state.  Finally, 
acceptable  responsiveness  is  achieved  using  a  gain  of  3.0 
as  illustrated  in  Figure  6.18  and,  therefore,  was  selected 
as  the  optimum  value  for  gain. 

A  pulsing  frequency  of  lOKHz  and  amplifier  gain  of  3 
were  independently  selected  by  observing  their  effects  on 
phase  plane  response  behavior.  However,  frequency  and  gain 
exhibit  coupled  effects  which  result  in  limit  cycle 
behavior.  While  limit  cycles  may  not  be  eliminated  solely 
through  the  selection  of  KpwM  and  fpwM'  tneY  maY  De 
minimized.  Steady  state  oscillations  are  small  in 
amplitude  for  the  parameter  selection  described.  However, 
when  gain  is  increased  and  frequency  decreased, 
unacceptable   magnification   of   limit   cycle   behavior   is 
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realized.  Figure  6.20  illustrates  the  effect  of  increasing 
amplifier  gain  to  50  while  maintaining  the  pulsing 
frequency  at  lOKHz.  Figure  6.21  shows  exaggerated  effects 
achieved  by  reducing  frequency  to  lKHz  with  gain  fixed  at 
3.  The  region  shown  by  the  circle  is  discussed  below. 
The  extent  of  limit  cycle  behavior  is  dependent  on  the 
amount  of  electromotive  energy  provided  to  the  motor  during 
the  delay  associated  with  the  PWM  pulsing  period.  For 
example,  consider  the  low  fPWM  trajectory  of  Figure  6.21. 
The  delay  observed  in  actual  controller  switching  caused  by 
the  finite  pulse  duration  which  extends  the  state  space 
forcing  vector  from  one  region  into  another.  The  delay 
highlighted  by  the  circular  region  in  Figure  6.21  may  be 
graphically  observed  in  Figure  6.22  by  examining  the  pulse 
width  modulator's  time  response  in  the  the  proximity  of 
switching.  Once  a  pulse's  duty  cycle  is  set,  the 
controller  is  temporarily  insensitized  to  operating 
conditions  for  the  remainder  of  the  pulse  period. 
Interpretation  of  Figure  6.22  confirms  that  limit  cycle 
behavior  may  be  reduced  by  increasing  pulsing  frequency  or 
decreasing  gain. 
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The  final  phase  of  this  preliminary  design  involves 
selection  of  feedback  gain  coefficients  K_  and  K^.  For 
analytical  simplicity,  unity  feedback  (K_  =  1)  is  chosen. 
Velocity  feedback  is  selected  relative  to  K_  and  determines 
the  extent  of  system  damping.  The  feedback  design 
performed  in  the  phase  plane  does  not  incorporate  dead  zone 
in  the  controller  for  the  sole  purpose  of  enhancing  the 
illustration  of  switching  line  behavior.  Specifically, 
reticence,  or  "chattering",  is  not  desired  and  might  be 
undetected  if  dead  zone  is  applied  in  this  preliminary 
stage  of  the  design. 

Lines  of  discontinuity  acquire  a  finite  slope  in  the 
phase  plane  when  velocity  feedback  is  used.  The  slope  is 
the  feedback  ratio,  -K^/K^,  and  applies  to  all  region 
boundaries.  Trajectory  interaction  with  the  switching  line 
provides  the  definition  for  damping  criteria.  For 
continuous  regulators,  sufficiently  large  velocity  feedback 
results  in  overdamped  behavior  characterized  by  no 
transient  oscillation.  The  system  trajectory  should 
approach,  but  not  intersect,  the  switching  line. 
Overdamping  discontinuous  controllers,  such  as  the  PWM,  is 
characterized  by  excessive  reticence  and  slow 
responsiveness.  If  velocity  feedback  gain  is  small  enough, 
then  the  system  trajectory  will  intersect  the  switching 
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line  and  yield  an  underdamped  oscillatory  transient.  The 
intersection  of  the  e-axis  by  the  trajectory  defines 
transient  overshoot.  Critical  damping  is  described  by  the 
condition  where  the  trajectory  coincides  with  the  switching 
line.  The  phase  plane  provides  a  graphic  method  of 
selection  of  damping  characteristics.  It  is  observed  that 
slope"  markers,  which  represent  system  response 
characteristics  unique  to  specific  operating  conditions, 
are  independent  of  Ky.  Furthermore,  region  #1  of  Table  IV 
describes  the  system's  natural  response  found  in  dead  zone 
operation.  Alignment  of  the  ICy  dependent  switching  line 
(dashed  line)  with  slope  markers  in  the  dead  zone  is  shown 
in  the  phase  plane  portrait  of  Figure  6.2  3  and  results  in 
critical  damping.  The  switching  line  slope  may  be 
increased  by  decreasing  Ky,  resulting  in  underdamped 
conditions.  Conversely,  increasing  Ky  tends  the  switching 
line  towards  horizontal  and  yields  overdamped  behavior. 

Figure  6.24  illustrates  overdamped  step  response 
behavior  attained  with  a  velocity  feedback  gain  coefficient 
of  Ky=0.01.  The  trajectory  is  characterized  by  excessive 
"chattering"  while  it  slowly  traverses  the  switching  line 
and  is  associated  with  large  Ky.  Near  critical  damping  is 
shown  in  Figure  6.25  where  Ky=0.005  and  is  characterized 
by  slow  transient  behavior  along  the  switching  line.   This 
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Figure  6.25  Phase  Plane  /  Critically  Damped  Step  Response 
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system  configuration  provides  optimal  position  control  in 
terms  of  energy  requirements,  but  is  not  well  suited  to 
this  high  performance  tracking  application.  Figure  6.2  6 
illustrates  underdamped  response  behavior  associated  with  a 
velocity  feedback  gain  coefficient  of  1^=0.0005.  The 
trajectory  is  oscillatory  and  exhibits  overshoot,  but 
provides  highly  responsive  transient  behavior. 
Characteristics  observed  in  the  phase  plane  of  Figure  6.27 
describe  good  step  response  performance  of  fin  position  for 
the  linearly  approximated  system  when  1^=0.001  and  support 
the  selection  of  this  velocity  feedback  gain  coefficient 
as  an  optimal  design  parameter  value.  The  slightly 
underdamped  response  shows  no  overshoot  and  has  a  fast 
settling  time.  Figures  6.28  and  6.29  show  agreement 
between  the  reduced  (2nd)  order  and  third  order  systems' 
step  time  response,  thereby  validating  results  attained  via 
the  phase  plane. 

The  phase  plane  described  by  e  and  e  for  step  response 
conditions  actually  describes  -0fin.  and  -Wfin«  The  plane 
may  readily  be  transformed  into  an  energy  plane,  where 
potential  energy  is  a  function  of  e  and  kinetic  energy  is  a 
function  of  e.  The  switching  line  which  passes  through  the 
steady  state  point  describes  conditions  of  locally 
maximized  kinetic  energy,  whereas  the  crossing  of  the  e- 
axis  describes   localized  minimum  kinetic  energy.     The 
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Figure  6.2  6  Phase  Plane  /  Underdamped  Step  Response 
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degree  of  response  stiffness  of  the  controller  is 
determined  by  the  amount  of  electromotive  energy  it 
provides  to  the  motor.  Increased  amplifier  gain  results  in 
greater  pulse  duty  cycles  for  given  system  conditions  and, 
hence,  greater  electromotive  energy  transmission.  The 
forced  harmonic  oscillation  frequency  also  increases  with 
amplifier  gain  and  results  in  greater  numbers  of  rotational 
reversals,  a  condition  to  be  avoided  whenever  possible. 

Ramp  response  analysis  is  also  supported  by  phase  plane 
methods  and  will  be  briefly  discussed.  The  natural 
response  component  of  the  slope  function  (r/)  described  by 
Equation  6.20  is  dependent  on  the  ramp  slope,  r.  When  r  is 
non-zero,  the  coordinates  (e,e)  do  not  linearly  transform 

to  (-Of  in'-a,fin)  and  the  ener9Y  plane  correlation  is  not 
valid.  Additionally,  the  phase  plane  is  no  longer 
symmetric  about  the  e-axis.  Consequently,  the  ramp 
response  portrait  is  significantly  different  than  that  of 
the  step  response. 

The  underdamped  controller  whose  step  response  was 

determined  in  Figure  6.27  was  subjected  to  a  ramp  input  of 

» 
slope  r=3000   deg/sec.    The  phase  plane  trajectory   is 

illustrated  in  Figure   6.30,   characterized  by  similarly 

acceptable   response   behavior.     Steady   state   error   is 

analytically  determined  to  be  ess=3 . 14  by  equation  6.21. 

Figures  6.31  and  6.32  provide  the  ramp  time  responses  of 
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the  second  and  third  order  lumped  parameter  models. 
Transient  behavior  is  rapid  and  steady  state  tracking 
accuracy  of  this  demanding  input  is  tolerable. 

Of  particular  interest  is  the  phase  plane 
representation  of  the  system's  dynamic  limitations  which 
describe  the  motor's  torque  capabilities.  Figure  6.3  3 
illustrates  the  case  where  the  system's  maximum  position 
tracking  rate  precludes  stable  convergence  when  a  ramp 
input  of  r=10000  deg/sec  is  used.  At  steady  state,  the 
trajectory  becomes  asymptotic  to  the  horizontal  line  given 
by  Equation  6.24.  Steady  state  error  is  infinite, 
indicating  ramp  response  instability. 

ess  =  r~wfss(o.L. )  =104-7277=2623  fin-deq     (6.24) 

sec 


The  phase  plane  has  been  used  extensively  in  this 
chapter  as  a  method  for  gaining  insight  of  the  controller's 
dynamics  and  for  selecting  preliminary  design  parameters. 
However,  two  important  final  design  considerations  remain 
unaddressed  and  are  the  focus  of  attention  in  Chapter  VII. 
Proper  design  of  this  electromechanical  system  requires 
compromise  between  system  performance  and  reliability  of 
electronic  components.    Additionally,  thorough  simulation 
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of  the  final  design  must  be  accomplished  using  the  detailed 
model  of  the  brushless  dc  motor. 
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VII.  PARAMETER  OPTIMIZATION  BY  SIMULATION  METHOD 

A.   BACKGROUND 

Proper  design  of  a  position  controller  for  an 
electronically  commutated  cruise  missile  fin  actuator 
demands  consideration  of  the  system's  mechanical  response 
characteristics  and  the  associated  transient  environment 
imposed  on  its  solid  state  components.  Preliminary  design 
based  solely  on  mechanical  performance  was  presented  in  the 
preceeding  chapter.  Electrical  transient  behavior  of  the 
system  was  developed  and  studied  in  Chapters  III  and  IV. 
The  central  theme  of  this  chapter  is  investigation  of 
electromechanical  design  considerations,  where  compromise 
between  mechanical  performance  and  electronic  reliability 
is  required.  The  application  of  pulse  width  modulation  to 
position  control,  studied  in  Chapters  V  and  VI,  was  shown 
to  provide  the  broad  performance  range  necessary  to 
accomodate  electrical-mechanical  design  compromises  and, 
therefore,  was  selected  as  the  means  of  fin  actuation 
control  for  this  design. 

Design  parameters  independently  determined  in 
preceeding  chapters  are  summarized  in  Table  V  and  yield 
good   electrical   and   mechanical   performance   properties. 
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These  values  serve  as  the  starting  point  in  the  final 
design. 

TABLE  V 

SUMMARY  OF  PRELIMINARY  DESIGN  PARAMETERS 

PWM  Amplifier  3.0 

Gain  (KpwM) 

PWM  Pulsing  lOKHz 

Frequency  (fPWM) 

PWM  Controller  0.0° 

Dead  Zone  (DBAND) 

Velocity  Feedback        0.001 
Gain  Coefficient  (Ky) 

Position  Feedback        1.0 
Gain  Coefficient  (K_) 

Bias  Threshold  50% 

Voltage  Divider  % 

Commutation  0.0° 

Offset  (THADV) 

Plugging  500  /xsec 

Delay  (TDPLUG) 

Decay  Rate  3  0 

Resistance  (RDADJ) 


System  performance  design  conducted  in  Chapter  VI  was 
based  primarily  on  small  scale  step  response  analysis. 
Using  a  3°  fin  perturbation,  phase  plane  trajectories  of  the 
reduced  order  model  were  characterized  by  slightly 
underdamped  behavior.  No  overshoot  and  very  little 
transient  oscillation  were  noted.   A  relatively  large  scale 
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ramp  response  (3000°/sec)  was  also  studied  using  the  same 
design  criteria,  and  was  observed  to  behave  very 
acceptably.  The  validity  of  this  design  based  on  lumped 
parameter  modeling  is  initially  ascertained  through 
simulation  using  the  detailed  brushless  dc  motor  model 
listed  in  Appendix  A.  Subsequent  to  fine  adjustment  of 
design  parameters,  large  scale  step,  ramp,  and  sinusoidal 
response  analyses  are  performed  to  determine  the 
controller's  robustness. 

B.   SIMULATION 

Validation  of  the  small  scale  step  response  analysis 
performed  in  the  phase  plane  is  readily  accomplished 
through  simulation  using  the  detailed  model  listed  in 
Appendix  A.  While  small  scale  step  analysis  does  not 
accurately  represent  the  tracking  dynamics  encountered  in 
missile  flight  control,  it  does  provide  a  general  and 
convenient  standard  for  selection  of  controller  design 
parameters. 

1.   Small  Scale  Step  Response 

Simulation  using  the  preliminary  design  parameters 
summarized  in  Table  V  duplicate  the  system  configuration 
selected  in  Chapter  VI.  In  addition  to  system  response 
verification,  observation  of  the  corresponding  electrical 
transient  behavior  is  afforded.  Figures  7.1  through  7.4 
illustrate   the   electromechanical   performance   of   the 
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Figure  7.2  Motor  Current  Step  Response  (Preliminary  Design) 
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preliminary  design  when  simulated  with  the  brushless  dc 
motor  model.  Figure  7.1  depicts  the  fin  position  response 
to  a  3°  step  input.  Of  particular  interest  is  the  presence 
of  a  25%  peak  overshoot,  which  was  not  predicted  by  the 
lumped  parameter  model  simulation.  Associated  with  the 
oscillatory  transient  are  a  relatively  large  current  demand 
exhibited  in  Figure  7.2  and  a  400  volt  spike  observed  in 
the  center  point  trajectory  of  Figure  7.3.  Torque  response 
characteristics  are  given  in  Figure  7.4  and  vividly  display 
the  relatively  long  duration  of  natural  response  due  to  the 
use  of  a  plugging  delay  time  (TDPLUG)  of  500^sec.  System 
relaxation  of  such  duration  invites  unacceptably  large 
degrees  of  ballistic  overshoot.  However,  plugging  delay  of 
some  extent  is  required  due  to  the  inevitable  requirement 
for  current  reversal  associated  with  forced  braking  of  the 
motor.  The  closed  loop  transient  analysis  performed  in 
Chapter  III  assumes  maximum  stiffness  in  the  controller's 
operation  and  employs  the  characteristics  of  an  ideal  relay 
to  simulate  such  behavior.  When  maximum  current  flow  is 
reversed,  there  is  an  understandable  need  for  dissipation 
of  excess  coil  energy.  However,  a  soft  controller  was 
determined  to  be  best  suited  in  the  preliminary  design  and 
pulse  width  modulation  using  an  amplifier  gain  (KpwM)  of  3 
was  selected.  The  resulting  buffering  action  provided  by 
the  controller  eliminates  the  need  for  a  lengthy  current 
decay  time   during  plugging.     Figures   7.5   through   7.8 
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illustrate  the  small  scale  step  response  behavior  using  a 
reduced  TDPLUG  of  10  ^sec.  No  overshoot  is  observed  in  the 
fin  position  step  response  shown  in  Figure  7 . 5  and  system 
behavior  is  virtually  identical  with  the  results  attained 
in  lumped  parameter  modeling.  Hence,  the  linear 
approximations  required  by  phase  plane  design  methods  are 
validated  and  shown  to  be  an  effective  means  of  predicting 
system  performance.  Figure  7.6  indicates  substantial 
reduction  in  current  demand  when  the  plugging  delay  is 
decreased  since  system  recovery  from  ballistic  overshoot  is 
not  required.  A  peak  voltage  surge  of  only  100  volts  is 
experienced  at  the  center  connection  and  is  shown  in  Figure 
7.7.  Figure  7.8  illustrates  the  absence  of  any  detectable 
period  of  natural  motor  torque  response  associated  with 
plugging  delay. 

The  erratic  current  response  behavior  illustrated 
in  Figure  7.6  between  .003  and  .004  seconds  is  attributed 
to  the  periodic  forcing  nature  of  the  PWM  controller  as  the 
fin  position  settles.  Near  steady  state  conditions,  the 
PWM  pulse  duty  cycle  is  small  and  does  not  receive 
effective  filtering  by  the  system's  electrical  time 
constant.  Therefore,  the  electrically  developed  torque 
shown  in  Figure  7.8  is  also  affected  by  the  pulsation.  It 
is  observed,  however,  that  the  dominant  mechanical  low  pass 
characteristics  of  the  motor  filters  the  oscillation  and 
results   in   the   smooth   position   response   shown   in 
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Figure  7.5   Fin  Position  Step  Response  (TDPLUG=10  /*sec) 
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Figure  7.6   Motor  Current  Step  Response  (TDPLUG=10  /zsec) 
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Figure   7.7      Node  0  Voltage  Response    (TDPLUG=10   /isec) 
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Figure  7.8   Motor  Torque  Step  Response  (TDPLUG=10  /xsec) 
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Figure  7.5.  The  inclusion  of  a  ±.5°  dead  zone  decreases  the 
extent  of  this  forced  oscillation  and  is  described  in 
Figures  7.9  through  7.11.  Figure  7.9  portrays  the  fin 
position  step  response  with  the  inclusion  of  dead  zone. 
Steady  state  accuracy  is  compromised  in  a  manner 
proportionate  to  the  extent  of  dead  zone  employed.  The  fin 
position  passes  through  its  intended  steady  state  position 
of  0°  and  settles  at  .5°.  Once  again,  the  relatively  large 
region  allowed  for  natural  response  supports  ballistic 
overshoot  of  the  fin  position  and  causes  additional 
undesired  forced  braking  action.  Because  the  motor 
undergoes  commutation  switching  at  0",  the  commutation  logic 
is  reverse  sequenced  and  results  in  current  reversal. 
Figure  7.10  indicates  reduced  susceptibility  of  the  motor 
current  to  the  pulsing  action  of  the  PWM  due  to  dead  zone, 
but  is  also  characterized  by  rapid  decay  of  current 
associated  with  the  interaction  of  plugging  and  commutation 
switching.  The  rapid  change  in  current  flow  is  responsible 
for  the  18  0  volt  spike  observed  in  the  center  connection 
voltage  response  of  Figure  7.11.  Analysis  of  small  scale 
step  response  indicates  that  inclusion  of  dead  zone  not 
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Figure  7.9   Fin  Position  Step  Response  (Dead  Zone  =  ±.5°) 
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Figure  7.10   Motor  Current  Step  Response  (Dead  Zone  =  ±.5°) 
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Figure  7.11   Node  0  Voltage  Response  (Dead  Zone  =  ±.5°) 
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only  degrades  system  accuracy,  but  also  accentuates 
electrical  transients  due  to  the  increased  need  for  forced 
braking. 

2 .   Large  Scale  Step  Response 

Stability  of  nonlinear  systems  often  is  largely 
dependent  on  the  initial  conditions  imposed.  Simulation  of 
a  large  scale  step  response,  for  example,  might  be  expected 
to  display  different  response  characteristics  of  the 
brushless  dc  motor  fin  position  controller  than  have  been 
observed  using  a  small  step.  In  application,  it  is  highly 
unlikely  that  the  missile  command  guidance  would  command  a 
45°  fin  step.  However,  because  of  its  excessive  nature, 
such  a  simulation  was  conducted  for  purposes  of  evaluating 
benchmark  performance.  Figures  7.12  through  7.14  illustrate 
the  electromechanical  performance  of  the  brushless  dc  motor 
subjected  to  a  45°  step  input.  The  fin  position  response 
shown"  in  Figure  7.12  indicates  a  15%  peak  overshoot  and  a 
comparatively  large  settling  time  of  0.02  seconds.  Both  of 
these  response  characteristics  are  highly  acceptable  and 
indicate  performance  robustness.  Figure  7.13  illustrates 
motor  current  large  scale  step  response  behavior.  Although 
average  current  demand  is  relatively  high  due  to  the  nature 
of  the  input,  the  current  response  is  very  well  behaved. 
Figure  7.14  shows  reasonable  Node  0  voltage  transients  in 
the  motor,   indicative  of  proper  commutation  operation  of 
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Figure  7.12   Fin  Position  Large  Scale  Step  Response 
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Figure  7.13   Motor  Current  Large  Scale  Step  Response 
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Figure  7.14   Node  0  Voltage  Large  Scale  Step  Response 
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the  power  conditioner.   A  maximum  center  connection  voltage 
surge  of  120  volts  was  observed. 
3 .   Ramp  Response 

Since  the  cruise  missile  fin  actuator  behaves  as  a 
tracking  device,  a  dynamic  range  of  input  values  permit 
more  realistic  analysis  of  the  controller.  A  stiff  ramp 
input-  signal  of  slope  3000  deg/sec  is  used  to  attain  the 
dynamic  response  behavior  of  the  actuator.  Similar 
analysis  was  previously  conducted  in  the  phase  plane  using 
the  lumped  parameter  model.  Although  ramp  response 
analysis  specifically  evaluates  the  positioning  device's 
ability  to  perform  as  a  constant  velocity  device,  it 
provides  rudimentary  dynamic  response  behavior  unavailable 
in  step  response  analysis.  Figures  7.15  through  7.19 
display  the  tracker's  dynamic  performance  characteristics 
simulated  using  a  relatively  demanding  ramp  input  of 
3  000deg/sec.  Tracking  performance  is  illustrated  in  Figure 
7.15  and  very  similar  to  the  behavior  observed  using  lumped 
parameter  modeling.  Steady  state  error,  as  defined  in 
Chapter  VI,  is  observed  and  is  considered  to  be  acceptable 
for  this  design  application.  Although  the  system  is 
underdamped,  transient  oscillation  is  negligible  and  forced 
braking  is  kept  to  a  minimum.  Figure  7.16  gives  the  motor 
current  ramp  response  and  is  characterized  by  a  relatively 
high  current  demand.    Additionally,   significant  harmonic 
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Figure  7.15   Fin  Position  Ramp  Response 
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Figure  7 . 16   Motor  Current  Ramp  Response 
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Figure  7 . 17   Motor  Torque  Ramp  Response 
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Figure  7.18   Node  0  Voltage  Ramp  Response 
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Figure  7.19   Transistor  #5  Voltage  Ramp  Response 
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oscillation  caused  by  PWM  pulsing  is  exhibited  near 
constant  velocity.  PWM  pulsing  is  more  clearly  shown  in 
the  torque  response  of  Figure  7.17,  where  transient  and 
steady  state  oscillation  also  are  exhibited.  A  center 
connection  peak  voltage  surge  of  150  volts  is  observed  in 
Figure  7.18.  The  voltage  response  of  Power  Transistor  #5 
is  illustrated  in  Figure  7.19.  The  pulsing  effects  of  the 
PWM  operating  at  low  duty  cycle  near  steady  state  are 
readily  observed  as  moderate  spiking  across  the  transistor. 
Although  this  ragged  forced  response  could  be  smoothed  with 
use  of  higher  pulsing  frequencies,  hardware  constraints 
preclude  such  implementation.  The  corresponding  voltage 
responses  shown  in  Figures  7.18  and  7.19  are  characterized 
by  high  frequency  voltage  transients  of  moderate  magnitude. 
Therefore,  despite  the  undesirable  pulsing  effects  of  the 
PWM,  the  ramp  response  characteristics  are  determined  to  be 
acceptable. 

4 .   Sinusoidal  Response 

The  final  and  most  realistic  simulation  performed 
evaluates  the  dynamic  tracking  performance  of  the  fin 
actuator  by  subjecting  the  controller  to  a  sinusoidal 
input.  The  ability  of  the  controller  to  track  sinusoidally 
varying  position  commands  demonstrates  true  tracking 
robustness.  To  simulate  typical  cruise  missile  command 
guidance   flight   correction   commands,   a   sine   wave   of 
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amplitude  3°  and  frequency  of  100Hz  was  used  as  a  reference 
input.  Figures  7.20  through  7.23  illustrate 
electromechanical  sine  wave  response  characteristics  of  the 
fin  actuator.  Good  tracking  characteristics  are  exhibited 
in  the  fin  position  response  of  Figure  7.20.  Although 
steady  state  error  varies  with  the  instantaneous  slope  of 
the  input,  it  is  acceptably  small  and  is  approximated  at  .3° 
at  the  sine's  point  of  inflection.  Figure  7.21  gives  the 
motor  current  sine  wave  response  and  indicates  considerable 
pulsing  activity  at  near  steady  state  conditions.  These 
pulses  are  realized  as  voltage  spikes  at  solid  state 
components  and  the  representative  conditions  at  power 
transistor  #5  are  illustrated  in  Figure  7.22.  However,  the 
spikes  are  sufficiently  small  (170  volts)  so  as  not  to 
degrade  solid  state  reliability.  Figure  7.23  shows  the 
center  point  trajectory  when  the  controller  is  subjected  to 
small "amplitude  sinusoidal  inputs.  A  peak  voltage  surge  of 
15  volts  is  highly  acceptable. 
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Figure  7.20   Fin  Position  Sinusoidal  Response 
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Figure   7.21      Motor  Current   Sinusoidal   Response 
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Figure  7.22   Transistor  #5  Voltage  Sinusoidal  Response 
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Figure  7.23   Node  0  Voltage  Sinusoidal  Response 
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C.   FINAL  DESIGN 

It  has  been  demonstrated  through  simulation  that  the 
position  controller  final  design  parameters  specified  in 
Table  VI  provide  robust  operational  performance.  Demanding 
mechanical  performance  is  achieved  with  an  electronically 
sensitive  brushless  dc  motor  through  the  adaption  of  pulse 
width-  modulation.  The  transient  waveshaping  incorporated 
in  this  design  appeared  to  significantly  modify  the 
electrical  response  characteristics  when  independently 
studied.  However,  the  coupled  electrical-mechanical  design 
performed  in  this  chapter  diminishes  the  impact  of 
waveshaping  and  relies  most  heavily  on  the  soft  response 
characteristics  of  the  PWM.  Oscillation  due  to  low  duty 
cycle  pulse  width  modulation  is  apparent  during  near-steady 
state  conditions,  but  its  effects  are  filtered  by  the  low 
pass  characteristics  of  the  brushless  dc  motor. 
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TABLE  VI 
SUMMARY  OF  FINAL  DESIGN  PARAMETERS 


PWM  Amplifier  3.0 

Gain  (KpwM) 

PWM  Pulsing  lOKHz 

Frequency  (fPWM) 

PWM  Controller  0.0° 

Dead  Zone  (DBAND) 

Velocity  Feedback        0.001 
Gain  Coefficient  (K^) 

Position  Feedback        1.0 
Gain  Coefficient  (K_) 

Bias  Threshold  50% 

Voltage  Divider  % 

Commutation  0.0° 

Offset  (THADV) 

Plugging  10  /xsec 

Delay  (TDPLUG) 

Decay  Rate  3  n 

Resistance  (RDADJ) 
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VIII.  CONCLUSIONS  AND  RECOMMENDATIONS 

A.   CONCLUSIONS 

It  has  been  demonstrated  through  computer  simulation 
that  the  brushless  dc  motor  has  viable  application  in 
position  control.  The  electronically  demanding  environment 
associated  with  forced  braking  and  bi-directional  motor 
operation  requires  that  considerable  attention  be  given  to 
the  power  conditioner's  electrical  transient  response 
characteristics.  The  central  theme  presented  in  this  study 
involves  the  design  compromises  required  to  exploit  the 
intrinsic  high  performance  of  a  brushless  dc  motor  without 
sacrificing  operational  reliability  of  its  solid  state 
components.  This  study  advances  an  on-going  comprehensive 
development  effort  of  cruise  missile  fin  control  using 
electromechanical  actuation. 

Reduced  peak  voltage  conditions  associated  with 
commutation  switching  were  attained  through  transient 
current  waveshaping  techniques  involving  modification  of 
power  conditioner  circuitry.  Pulse  width  modulation  in 
closed  loop  position  control  was  observed  to  provide 
electrically  advantageous  response  buffering  during 
rotational  reversals  of  the  motor. 

System  performance  was  initially  evaluated  in  the  phase 
plane  and  preliminary  design  parameters  based  on  a  reduced 
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order  lumped  parameter  model  were  identified.  Composite 
analysis  of  the  electromechanical  actuator  was  conducted 
through  computer  simulation  using  the  detailed  model  of  the 
brushless  dc  motor  listed  in  Appendix  A.  Following  minor 
power  conditioning  parameter  adjustments,  simulated  results 
were  highly  consistent  with  system  performance  observed 
using- linear  approximation  methods  and  electrical  transient 
behavior  was  observed  to  be  very  satisfactory.  The 
controller  was  found  to  be  functionally  robust  based  on 
response  evaluation  using  small  and  large  step,  ramp,  and 
sinusoidal  inputs. 

The  four  pole  brushless  dc  motor  modeled  in  this  study 
is  based  on  typical  motor  specifications  and  limited 
physical  benchmark  measurements  of  this  motor  conducted  at 
NWC,  China  Lake.  Consequently,  validation  of  the  model  is 
limited  to  the  extent  of  available  performance  data. 
Ongoing  cruise  missile  fin  actuator  design  efforts  using 
brushless  dc  motors  at  NWC,  China  Lake  promise  a  more 
complete  and  reliable  performance  data  base  for  future 
modeling  improvements.  The  interactive  nature  of  the 
simulation  program  permits  easy  access  to  motor  and 
controller  parameters  and  facilitates  future  parameter 
modification  to  accommodate  updated  performance 
measurements.  Validation  of  the  computer  simulation  was 
performed  not  only  with  comparison  of  predicted  and 
physically  observed  behavior,  but  also    with  analytical 
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methods.  Lumped  parameter  modeling  and  state  space 
solutions  determined  in  Chapter  VI  were  used  to  accurately 
predict  the  detailed  simulation  results  of  Chapter  VII. 

B.   RECOMMENDATIONS  FOR  FURTHER  STUDY 

All  analyses  performed  in  this  study  were  based  on 
linear  fin  actuator  load  conditions.  Mechanical  linkage 
design  consideration  with  inclusion  of  loading  and  power 
transmission  effects,  such  as  modeled  in  Wright's  thesis 
[Ref.12],  should  be  investigated  for  torsional  and  stall 
torque  operating  conditions. 

The  numerical  accuracy  of  all  computer  simulations 
conducted  in  this  work  is  limited  by  the  nature  of  small 
step  trapezoidal  integration  and  should  be  considered  as  an 
area  for  future  improvement.  Since  convergence  criteria  is 
constantly  monitored,  modification  to  the  integration 
method  may  be  readily  evaluated  through  observation  of 
numerical  convergence  behavior. 

A  study  of  power  dissipation  and  heat  sinking 
requirements  of  solid  state  components  is  warranted  based 
on  the  high  current  demands  observed  during  simulation,  of 
position  control. 

Feasibility  of  electrical  power  regeneration  during 
dynamic  braking  action  of  the  motor  was  suggested  and 
deserves  more  extensive  evaluation  in  future  studies. 
Because  of  the  anticipated  lengthy  duration  of  missile 
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flight  control,  adaption  of  such  an  energy  conservation 
measure  would  reduce  the  demand  on  the  missile  power  supply 
and  conceivably  support  size  and  weight  reduction. 

Improved  modeling  of  diode  response  characteristics 
will  enhance  the  simulation  of  freewheeling  action 
encountered  during  commutation  switching.  Presently, 
diodes  are  modeled  as  either  conducting  or  not  conducting, 
depending  on  bias  conditions.  The  corresponding  diode 
resistance  characteristics,  therefore,  are  discontinuously 
modeled  and  require  artificial  programming  techniques  to 
simulate  their  physical  behavior. 


177 


APPENDIX  A 
BRUSHLESS  DC  MOTOR  SIMULATION  PROGRAM 


SNOfloatcalls 

SNOdebug 

C  . . .  MAIN  PROGRAM 

C      

C      I 


C  I   ROSSITTO,  VS    THESIS     PROF  GERBA   03/26/87  | 

C      | BRUSHLESS  DC  MOTOR | 

C 

C  SYSTEM  REQUIREMENTS 

C 

C  This  simulation  is  written  for  compilation  using  MS  FORTRAN77  V3.31. 

C  Three  programs:  BLDCM1.F0R,  BLDCM2.FOR,  &  BLDCM3.FOR  must  be 

C  compiled  and  linked.  This  version  uses  PLOTWORKS  PL0T88  for  graphic 

C  output  support;  the  library  must  be  included  during  linking. 

C 

C  -  Hardware  Reqmts  — >  INTEL  8088/8086  family  (PC/XT) 

C  or   INTEL  80286  family  (AT) 

C  {{  INTEL  8087/80287  math  coprocessor  highly  recommended}} 

C  -  Memory  Reqmts  — >  6A0K  (RAM  resident  utility  programs  may  have 

C  to  be  stripped. ) 

C  -  Storage  — >  Hard  Disk  preferred,  Minimum  2  Floppy  Drive  System 

C  For  use  with  floppy  drives,  virtual  memory  scheme 

C  requires  360KB  data  disk.  The  selection  of  VM  default 

C  drive  is  menu  selectable. 

C  -  DOS  Configuration  — >  CONFIG.SYS  file  must  contain: 

C  device-ANSI. SYS 

C  files-15 

C  -  Support  Files  — >  BLDCM.INP  (formatted  input  data  which  is 

C  accessible  during  execution  of  program) 

C  BLDCM1.VIR  | 

C  BLDCM2.VIR  |  These  <*   files  are  generated  by 

C  BLDCM3.VIR  |  the  simulation  program  and  are 

C  BLDCM4.VIR  |  used  as  virtual  memory. 

C 

C  PROGRAM  DESCRIPTION 

C  This  program  simulates  the  detailed  operation  of  a  bipolar, 

C  three  phase  brushless  dc  motor.  Console  interaction  by  the  user 

C  provides  the  ability  to  simulate  under  a  broad  range  of  operating 

C  parameters  as  well  as  initial  conditions.  Since  the  simulation 

C  is  intended  to  be  used  primarily  for  design  purposes,  repetitive 

C  iterations  with  saved  data  are  possible. 

C  The  method  of  simulation  used  in  this  program  emulates 

C  processing  through  the  use  of  two  nested  systems  of  non-linear 
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C     differential  equations.   The  inner  loop  serves  to  describe  the 

C     electrical  system  response,  while  the  outer  loop  describes  the 

C     electro-mecanical  system  response.   Both  systems  of  non-linear 

C     differential  equations  are  solved  using  Newton-like  iterative 

C     convergence  schemes.  The  inner  loop  is  numerically  stiff  in  that 

C     the  non-linear  nature  of  the  diode  equivalent  resistance  allows 

C     numerical  convergence  to  two  solutions  when  the  diode  cutoff 

C     threshold  is  approached.  This  is  dealt  with  by  using  a  fixed, 

C     but  relatively  small  step  size  and  a  cautious  modified  Newton's 

C     method  of  solution. 

C  Trapezoidal  integration  is  used  for  computational  speed. 

C     Comparison  to  results  attained  using  Runge-Kutta  methods  on  IBM- 

C     370  based  CSMP  indicate  good  accuracy.   The  first  order 

C     differential  equation  solver,  TCONST,  is  an  algebraic  solver  and 

C     provides  a  rapid  means  of  solving  an  otherwise  iterative  problem. 

C 

C     Variable  Descriptors  are  explained  throughout  the  program  and, 

C     therefore,  will  not  be  described  here. 

C 

IMPLICIT  REAL*4  (A-Z) 

COMMON  BEGT IM , F I NT IM , NPTS , IOPORT , MODEL , XLEN ,  YLEN , PLEN , PLEN 1 , 
+       XTITLE.YTITLE.PTITLE.PTITl 
REAL**  XTIME(IOIO) 

INTEGER*2  NTIME , NTERMS , IOPORT , MODEL , NUMIT , NUMIN , XLEN , YLEN , N , 
+        NTIM1 , NTIM11 , NTIM12 , NTIM13 , NTIM1A , 
+        NTIM21 , NTIM22 , NTIM23 , NTIM32 , NTIM33 , NTIM34 , NTIM35 , 
+        ELEMNT.SIM2PL, POSIT, DIR, 

+        NTIM01 .NTIM02 , NTIM03 , NTIM04 , NTIM05 , NTIM06 , HALF, 
+        NTIM«7,NTIM«8,PMODEL,NCTR,NPTS,AHALF,BHALF,CHALF, 
+        TRIG1 , TRIG2 , TRIG3 , TRIG4 , TRIG5 , TRIG6 , DIRM1 , PLUG 
logical*2  TOGGLE 
character*3  DISOPT, DRIVE, DRIVE1 

character*6  ANSI , ANS11 , ANS21 , ANS27 , PRTSEL , NONLIN , TYPE , TYPE1 
character*25  XTITLE, YTITLE.NLCHAR 
character*51  PRTCHR.PTITLE.PTITl 
C 

C   ...  Introductory  Page  (1  time  good  deal!) 
call  CLRSCR 
write<*,<0 
PAUSE 
C 
C   ***  Open/Read/Close  input  data  file  *** 

13  open ( 2 , FILE- ' BLDCM . INP ' , STATUS- ' OLD  * , ACCESS- ' SEQUENTIAL  * ) 
read( 2 , 1000 )  PMODEL , PRTCHR , RIN , ROUT , RDADJ 
read(2,1020)  BEGTIM,FINTIM,PTSPLT,MAXITS,SIM2PL 
read(2,1022)  KPWM,KV,E0 ,EDOT0 .TTIME.XORG, YORG 
read(2,1024)  RS , RSAT , JL , BL , KTM 
read(2,1026)  JM , RA , LA , KBM , THADV , TDPLUG 
read(2,1028)  BM.KP, PERIOD, DBAND.KA 
read (2, 1030)  TYPE , RCUT , STPMAG , RSLOPE 
read(2,1032)  SINAMP.SINFRQ.SINPHA, DRIVE 
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close(2,STATUS=*KEEP') 
C 
C 
c     ************************************ 

C     ***  DISPLAY  MAIN  MENU  SELECTIONS  *** 
(j     ************************************ 

C 

1  call  CLRSCR 

call  GOT0XY(8,l) 
write(*,5) 
read(*,'(A)')  ANSI 
C   ...  Hardware  Options  . . . 

if  ((ANSI  .  eq.  'h' )  .or.  (ANSI  .eq.  'H'))  then 
C 
101     call  CLRSCR 

call  GOTOXY(17,24) 

write (*,*)'***  CURRENT  PRINTER  SELECTION  ***' 
call  GOTOXY(20,20) 
write(*,*)  PRTCHR 
call  GOTOXYU0.1) 
write(*,105) 
read(*,'(A)* )  ANS11 
C 
C   ...  Printer  Options  . . . 

if  ((ANS11  .eq.  'p')  .or.  (ANS11  .eq.  'P'))  then 
call  PRNOPT(PMODEL,PRTSEL, PRTCHR) 
go  to  101 
C 
C   ...  Quit  the  Hardware  Menu  . . . 

elseif((ANSll  .eq.  'q' )  .or.  (ANS11  .eq.  'Q'))  then 

go  to  1 
else 

go  to  101 
endif 
C 
C   ...  Motor  Parameters  . . . 

elseif  ((ANSI  .eq.  'm' )  .or.  (ANSI  .eq.  'M'))  then 
C 

call  MOTPAR(KTM,KBM,RIN,ROUT,RDADJ,RA,LA,BM,BL,JM,JL, 
+  RSAT,RCUT,TTIME,RS,THADV,TDPLUG) 

go  to  1 
C 

C   ...  NON-LINEAR  ELEMENT  SELECTION  MENU  . . . 
C 

elseif  ((ANSI  .eq.  'n' )  .or.  (ANSI  .eq.  'N'))  then 
14    call  CLRSCR 

call  GOTOXY(21,1) 
write (*, 272)  NLCHAR 
call  GOTOXY(1,1) 
write(*,270)  KV.KP 
read(*,'(A)')  ANS27 
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. . .  RELAY  AS  NON-LINEAR  ELEMENT  . . . 

if  ((ANS27  .eq.  'r')  .or.  (ANS27  .eq.  'R'))  then 
ELEMNT=1 
NLCHAR=' RELAY' 
291       call  CLRSCR 
NONLIN«'R' 
write(*,290)  DBAND 
read<*. '(A)')  ANS21 

if  (ANS21  .eq.  'DBAND')  then 
call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  DBAND-->  ' 
read(*,*)  DBAND 
go  to  291 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  291 
endif 
. . .  PULSE  WIDTH  MODULATOR  AS  NON-LINEAR  ELEMENT  . . . 

elseif  ((ANS27  .eq.  'p')  .or.  (ANS27  .eq.  'P'))  then 
ELEMNT-3 

NLCHAR-' PULSE  WIDTH  MODULATOR' 
301       call  CLRSCR 
NONLIN-'P' 

write (*, 300)  DBAND , PERIOD , KPWM 
read(*,'(A)')  ANS21 

if  (ANS21  .eq.  'DBAND')  then 

call  GOTOXY(24,l) 

write(*. ' (A\)' )*Enter  a  REAL  value  for  DBAND-->  ' 

read(*,*)  DBAND 

go  to  301 
elseif  (ANS21  .eq.  'PERIOD')  then 

call  GOTOXY(24,l) 

write(*, ' (A\ )') 'Enter  a  REAL  value  for  PERIOD— >  * 

read(*,*)  PERIOD 

go  to  301 
elseif  (ANS21  .eq.  'KPWM')  then 

call  GOTOXY(24,l) 

write(*, ' (AV)' ) 'Enter  a  REAL  value  for  KPWM-->  ' 

read(*,*)  KPWM 

go  to  301 
elseif  ((ANS21  .eq.  *q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  301 
endif 

elseif  ((ANS27  .eq.  'KV')  .or.  (ANS27  .eq.  'kv'))  then 
call  GOTOXY(24,l) 
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write(*, ' (A\ ) ' ) 'Enter  a  REAL  value  for  KV-->  ' 
read(*,*)  KV 
go  to  14 
C 

elseif  ((ANS27  .eq.  'KP' )  .or.  (ANS27  .eq.  'kp'))  then 
call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  KP— >  ' 
read(*,*)  KP 
go  to  14 
C 

elseif  ((ANS27  .eq.  'q')  .or.  (ANS27  .eq.  'Q'))  then 

go  to  1 
else 

go  to  14 
end  if 
C 
C   ...  Simulation  Options  . . . 

elseif  ((ANSI  .eq.  'o')  .or.  (ANSI  .eq.  '0'))  then 
C 

202     call  CLRSCR 
C 

DELTIM-(FINTIM-BEGTIM)/(PTSPLT*SIM2PL) 
if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 
NTERMS-IFIX(FINTIM/DELTIM)+1 
C 

write (*, 240)  BEGTIM, FINTIM, PTSPLT, MAXITS, SIM2PL.E0 ,EDOT0 , 
+  XORG , YORG , DRIVE , DELT IM , NTERMS 

read(*,'(A)')  ANS21 
C 

if  (ANS21  .eq.  'BEGTIM')  then 
call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  BEGTIM— >  ' 
read(*,*)  BEGTIM 
go  to  202 
elseif  (ANS21  .eq.  'FINTIM')  then 
call  GOTOXY(24,l) 

write(*. '(A\)')'Enter  a  REAL  value  for  FINTIM— >  ' 
read(*,*)  FTIME 
if  (FTIME  .le.  BEGTIM)  then 
call  CLRSCR 
call  GOTOXYQO.IO) 

write(*,*)  'INVALID  FINTIM  ...  FINTIM  must  be  >  BEGTIM' 
go  to  202 
endif 

FINTIM-FTIME 
go  to  202 
elseif  (ANS21  .eq.  'PTSPLT')  then 
call  GOTOXY(24,l) 

write (*,' (A\ )' )' Enter  a  REAL  value  for  PTSPLT— >  ' 
read(*,*)  PTSPLT 
go  to  202 
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elseif  (ANS21  .eq.  'MAXITS*)  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  MAXITS— >  ' 

read(*,*)  MAXITS 

go  to  202 
elseif  (ANS21  .eq.  'SIM2PL')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  INTEGER  value  for  SIM2PL-->  ' 

read(*,*)  SIM2PL 

go  to  202 
elseif  (ANS21  .eq.  'E0')  then 

call  G0T0XY(24,1) 

write(*, ' (A\)' )'Enter  a  REAL  value  for  E0  (degrees)-->  ' 

read(*,*)  E0 

go  to  202 
elseif  (ANS21  .eq.  'EDOT0')  then 

call  GOTOXY(24,l) 

write(*, ' (A\ )') 'Enter  a  REAL  value  for  EDOT0  (deg/sec) — > 

read(*,*)  EDOT0 

go  to  202 
elseif  (ANS21  .eq.  'XORG' )  then 

call  GOTOXY(24,l) 

write(*, *(A\)' ) 'Enter  a  REAL  value  for  X0RG-->  ' 

read(*,*)  XORG 

go  to  202 
elseif  (ANS21  .eq.  'YORG' )  then 

call  GOTOXY(24,l) 

write(*,'(A\)')' Enter  a  REAL  value  for  YORG— >  * 

read(*,*)  YORG 

go  to  202 
elseif  (ANS21  .eq.  'DRIVE')  then 

call  GOTOXY(2A,l) 

write(*, ' (A\)' ) 'Enter  Drive  (A,B,C)  for  data  storage  -->  ' 

read(*, '(A)*)  DRIVE1 

if  ((DRIVE1  .eq.  *A' )  .or.  (DRIVE1  .eq.  *a'))  then 
DRIVE- 'A' 

elseif  ((DRIVE1  .eq.  'B')  .or.  (DRIVE1  .eq.  'b'))  then 
DRIVE-' B' 

elseif  ((DRIVE1  .eq.  'C')  .or.  (DRIVE1  .eq.  'c'))  then 
DRIVE-'C 

else 

call  CLRSCR 

call  GOTOXY(10,20) 

write(*,*)  'Invalid  Drive  Specified  -  Enter  A,  B.or  C 

PAUSE 

endif 

go  to  202 
Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq.  'Q' )  then 

go  to  1 
else 
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go  to  202 
end  if 
C 
C   ...  Command  Input  Selection  . . . 

elseif  ((ANSI  .eq.  'c')  .or.  (ANSI  .eq.  'C*))  then 
C 

203     call  CLRSCR 
C 

write(*,245)  TYPE, STPMAG, RSLOPE, SINAMP, SINFRQ, SINPHA 
read(*, ' (A)* )  ANS21 
C 

if  (ANS21  .eq.  'TYPE')  then 
call  GOTOXY(24,l) 

write(*,' (A\)' ) 'Enter  a  STEP,  RAMP,  or  SINE— >  ' 
read(*,*(A)' )  TYPE1 

if  ((TYPE1  .ne.  'STEP')  .and.  (TYPE1  .ne.  'RAMP')  .and. 
+  (TYPE1  .ne.  'SINE'))  then 

call  CLRSCR 
call  GOTOXY(10,10) 
write(*,*)  'Invalid  Selection  !!!' 
call  GOTOXY(20,1) 
PAUSE 
go  to  203 
else 

TYPE-TYPE 1 
endif 
C 

go  to  203 
elseif  (ANS21  .eq.  'STPMAG')  then 
call  GOTOXY(24,l) 

write (*, '(A\)' ) 'Enter  a  REAL  value  for  STPMAG— >  * 
read(*,*)  STPMAG 
go  to  203 
elseif  (ANS21  .eq.  'RSLOPE')  then 
call  GOT0XY(24,l) 

write(*. ' (A\)' ) 'Enter  a  REAL  value  for  RSLOPE— >  ' 
read(*,*)  RSLOPE 
go  to  203 
elseif  (ANS21  .eq.  'SINAMP')  then 
call  GOTOXY(24,l) 

v*rite(*, ' (A\)' ) 'Enter  a  REAL  value  for  SINAMP— >  ' 
read(*,*)  SINAMP 
go  to  203 
elseif  (ANS21  .eq.  'SINFRQ')  then 
call  GOTOXY(2«,l) 

write(*. * (A\)' )' Enter  a  REAL  value  for  SINFRQ— >  ' 
read(*,*)  SINFRQ 
go  to  203 
elseif  (ANS21  .eq.  'SINPHA')  then 
call  GOTOXY(24,l) 
write(*. ' (A\)' ) 'Enter  a  REAL  value  for  SINPHA— >  ' 
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read(*,*)  SINPHA 
go  to  203 
,  Quit  Simulation  Options  Menu  . . . 
eiseif  (ANS21  .eq.  'Q' )  then 

go  to  1 
else 

go  to  203 
end  if 
.  Save  Options  to  File  ... 
eiseif  ((ANSI  .eq.  's')  .or.  (ANSI  .eq.  'S'))  then 


***  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  *** 


open(2,FILE='BLDCM.INP' , STATUS= *  OLD • ,ACCESS=' SEQUENTIAL' ) 
write(2,1000)  PMODEL , PRTCHR , RIN , ROUT , RDAD J 
wr i te ( 2 , 1020 )  BEGTIM , FINTIM , PTSPLT , MAXITS , SIM2PL 
write (2, 1022)  KPWM,KV,E0,EDOT0,TTIME,XORG,TORG 
write(2,1024)  RS , RSAT , JL , BL , KTM 
write(2,1026)  JM,RA,LA,KBM,THADV,TDPLUG 
write (2, 1028)  BM , KP , PERIOD , DBAND , KA 
write(2,1030)  TYPE,RCUT,STPMAG,RSLOPE 
write(2,1032)  SINAMP.SINFRQ, SINPHA, DRIVE 

close (2, STATUS- 'KEEP' ) 


go  to  1 

,  Run  the  Program  . . . 

eiseif  ((ANSI  .eq.  'r')  .or.  (ANSI  .eq.  *R'))  then 
go  to  2 

.  Quit  the  Program  ... 
eiseif  ((ANSI  .eq.  'q')  .or.  (ANSI  .eq.  *Q'))  then 

stop 
else 

go  to  1 
endif 


Open  an  output  data  file 

continue 

if  (DRIVE  .eq.  'AJ )  then 

OPEN(4,FILE-'a:BLDCMl.VIR' 
OPEN ( 5 , FILE-' a : BLDCM2 . VIR' 
OPEN ( 6 . FILE- ' a : BLDCM3 . VIR ' 
OPEN ( 7 , FILE- ' a : BLDCM4 . VIR ' 

eiseif  (DRIVE  .eq.  'B')  then 
OPEN ( 4 , FILE- ' b : BLDCM1 . VIR ' 
OPEN(5,FILE-'b:BLDCM2.VIR' 
OPEN(6,FILE=*b:BLDCM3.VIR' 
OPEN(7,FILE='b:BLDCM4.VIR' 


STATUS- 'NEW') 
STATUS- 'NEW') 
STATUS- 'NEW') 
STATUS- 'NEW') 

STATUS- 'NEW') 
STATUS- 'NEW') 
STATUS- 'NEW') 
STATUS- 'NEW') 
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elseif  (DRIVE  .eq.  'C )  then 

OPEN ( 4  ,  FILE- '  c  :  BLDCM1 .  VIR *  ,  STATUS- '  NEW '  ) 
OPEN ( 5 , FILE= ' c : BLDCM2 . VIR ' , STATUS- ' NEW ' ) 
OPEN(6,FILE='c:BLDCM3.VIR* ,STATUS='NEW' ) 
OPEN ( 7 , FILE= ' c : BLDCM4 . VIR  * , STATUS- ' NEW ' ) 

end  if 
C 

C  ***  Listing  of  constants  *** 
C 

PI  -  3.14159265 

KADJ-0 . 63 

KK3  -  3.590 

TN2-.1 

N-30.0 

TCIMC-0.01 

TLL-0 . 0 

VSAT- . 4 

REVTIM-0 . 1 

VN1-0. 

VN2-0. 

VSGREF-30. 

KINT-10000. 

KRAMP-18000. 

VSG-0. 

VINHF1-75.0 

REDRAT-.l 
C 
C      Initial  Conditions 

TRIG1-0 

TRIG2-0 

TRIG3-0 

TRIG4-0 

TRIG5-0 

TRIG6-0 

WM-0. 

THETA-0 . 

PTHETA-0 . 0 

THETA1-0 . 

IMA-0 . 0 

IMB-0 . 0 

IMC-0 . 0 

IMAB-0 . 0 

IMBC-0 . 0 

IMCA-0 . 0 

NCTR-0 

NPTS-0 

NTIM1-0 

NTIM01-0 

NTIM02-0 

NTIM03-0 

NTIM04-0 
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NTIM05=0 
NTIM06-0 
NTIM11-0 
NTIM12-0 

NTIM13=0 

NTIMU-0 

NTIM21=0 

NTIM22=0 

NTIM01-0 

NTIM02=0 

NTIM03=0 

NTIM04=0 

NTIM05=0 

NTIM06=0 

NTIM32=0 

NTIM33=0 

NTIM34-0 

NTIM35-0 

ICQ1-.75 

ICQ2=.75 

ICQ3-.75 

ICQ4-.75 

ICQ5-.75 

ICQ6-.75 

ICIMAB-0 . 

ICIMBC-0 . 

ICIMCA-0 . 

ICTMF-0 . 

ICWM-O. 

Xl-0.0 

Fl-0.0 

F2-0.0 

X3-0 . 0 

ZA3-0 . 0 

ZB3-0 . 0 

ZC3-0.0 

TSTART-0 . 0 

TOGGLE- .  true . 

VIN-0 . 

PREV5-0. 

CURV5-0 . 

HOLD 1-0. 

PREV2-0. 

PREV2-0 . 

PREV3-0. 

YY2-0. 

YY3-0. 

YYA-0. 

YDM12-0 . 

YDM13-0. 

YDM14-0. 
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YD2-0 . 

YD3-0. 

YD4=0. 

YDDM12=0 . 

YDDM13=0 . 

YDDMU=0 . 

YDD2-0 . 

YDD3=0. 

YDDA-O. 

PREV7=0. 

CURV7=0 . 

HOLD3=0 . 

PLUG=0 

TFPLUG=0 . 

DIRM1=0 
C 
C      RELATIONSHIPS 

KT=KTM*KADJ 

KB=KBM*KADJ 

BLP=BL/(N**2) 

JLP-JL/(N**2) 

J-JM+JLP 

B-BM+BLP 

Al-LA/RA 

A2-J/B 

A3-LA/(RA+RSAT) 

RS1-RS/2. 

RS2-RS/2. 

VINIC-15.0/KINT 

VINHAF-VINHFl 
C   ...  Initial  conditions  for  THETAC fin , degrees )  and  Omegat fin , degrees ) 

E0RAD=E0*PI/ ( 180 . *REDRAT ) 

EDOT0R=EDOT0*PI / ( 180 . *REDRAT ) 

if  (KP  .ne.  0. )  then 
WMO— EDOT0R/KP 
THETAO— EORAD/KP 

elseif  (KP  .eq.  0.)  then 
WMO— EDOT0R 
THETAO— EORAD 

end  if 

WM-WMO 

X3-THETA0 
C 

C   ...  Output  Simulation  Options  to  Output  Data  File  . . . 
C 
C   ************************************* 

C  *****  Time  Generator  . . .  0-50ms  ***** 


C 


DELTIM=(FINTIM-BEGTIM) / (PTSPLT*SIM2PL) 

if  (FINTIM/DELTIM  .  gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS=IFIX(FINTIM/DELTIM)+1 
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SPACE=DELTIM/2. 
C 

C  ***  Clear  Screen  &  Home  Cursor  *** 
call  CLRSCR 
call  GOTOXY(10,29) 

write(*,*)  'Elapsed  Simulation  Time' 
call  GOTOXY(12,41) 
write(*,*)  'seconds' 
call  G0T0XY(15,1) 

write ( * ,  15 )  BEGTIM , FINTIM, DELTIM, NTERMS 
15   format (22X, 'Simulation  Start  Time  — >  ',F8.7,/, 

+      23X, 'Simulation  Stop  Time  >  ' ,F8.7,/, 

+       23X, 'Simulation  Step  Size  >  ',F8.7,/, 

+       23X, 'Total  Number  of  Steps  -->  ',14) 
call  GOTOXY(21,l) 
C 

if  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 
write(*,*)  '  ***  NON-LINEAR  ELEMENT  IS  RELAY 

+  ***  ■ 

elseif  ((NONLIN  .eq.  *p')  .or.  (NONLIN  .eq.  'P'))  then 
write(*,*)  '  ***  NON-LINEAR  ELEMENT  IS  PWM 

+  ***  ■ 

else 
write (*,*)  '  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  '  ...  Return  to  Main  Menu  ..." 

PAUSE 
go  to  1 
endif 
C 

DO  100  NTIME  =  1, NTERMS 
TIME  -  (NTIME- 1)*DELTIM 
C  ***  Output  Elapsed  Simulation  Time  to  Display  *** 
C 

call  GOTOXYQ2.33) 
write(*,93)  TIME 
93  format(F7.6) 
C 

C   ...  Command  Input  Signal  Generator  . . . 
if  (TYPE  .eq.  'STEP')  then 

ORDER=STPMAG 
elseif  (TYPE  .eq.  'RAMP')  then 

ORDER=RSLOPE*TIME 
elseif  (TYPE  .eq.  'SINE')  then 

ORDER=SINAMP*sin(SINFRQ*TIME+SINPHA) 
endif 
C 

VSGDEL- ( VSGREF - VSG ) / 2 . 

PI— .5 

P2=.5 

call  DEADSP(P1,P2, VSGDEL, VSGERR) 

call  INTGRL(NTIME,NTIM21, DELTIM, VINIC.PREV5, VSGERR, 
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+  CURV5,H0LD1,VININT) 

VINHFG=KINT*VININT 
C 
c       **************************************** 

C   *****  INITIAL  ITERATIVE  CONDITIONS  ***** 
n         **************************************** 

if  (NTIME  .oq.  2)  then 

WM=WM+(ORDER-X3)*l.E-3 

X3=X3+(ORDER-X3 ) *1 . E-3 

ZA3-1.E-6 

ZB3=-l.E-4 

ZC3-1.E-4 
endif 
HALF-0 
r        ********************************************************* 
q        *******************   ITERATIVE  LOOP  ********************** 

Q  ********************************************************* 

do  500  NUMIT-1,20 
THETA-X3 
C 
C  ***  Phase  angles  *** 

BEMFA-(3.0*SIN(2.0*THETA+(11.0*PI/6.0))+.590*SIN(10.0* 
+       THETA+(1.0*PI/6.0))) 

BEMFB-( 3 . 0*SIN ( 2 . 0*THETA+( 7 . C*PI / 6 .  0 ) )+ . 590*SIN ( 10 . 0* 
+        THETA+(5.0*PI/6.0))) 

BEMFC«(3.0*SIN(2.0*THETA+(3.0*PI/6.0))+.590*SIN(10.0* 
+        THETA+(9.0*PI/6.0))) 
C  ***  Normalize  leg  EMF  *** 

VEMFA  -  BEMFA  *  KB/KK3  *  WM 
VEMFB  -  BEMFB  *  KB/KK3  *  WM 
VEMFC  -  BEMFC  *  KB/KK3  *  WM 
VEMFAC  -  VEMFA  -  VEMFC 
VEMFBA  =■  VEMFB  -  VEMFA 
VEMFCB  -  VEMFC  -  VEMFB 
C 

call  CCMADV(THETA,PI,float(DIR)*THADV,THCON,THRST) 
call  HALL(THC0N,SE1,SE2,SE3) 
C 

THETAF-REDRAT*THETA*180 . /PI 
OMEGAF-REDRAT*WM*180 . /PI 
POSERR-ORDER-KP*THETAF-KV*OMEGAF 
C 

C   ...  Utilization  of  Non-Linear  Element  . . . 
C   ...  PULSE  WIDTH  MODULATOR  . . . 

if  ((NONLIN  .eq.  'p' )  .or.  (NONLIN  .eq.  *P'))  then 
call  PWMOD (TIME , NUMIT , TSTART , PERIOD , TOGGLE . POSERR, 
+  DBAND, V IF, VI B,DIR,VREF, THRESH, KPWM) 

C   ...  IDEAL  RELAY  . . . 

elseif  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 

call  RELAY (POSERR, DBAND, VIF.VIB.DIR) 
else 
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call  G0T0XY(21,D 

write (*,*)  '  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  '  ...  Return  to  Main  Menu  ..." 

PAUSE 

go  to  1 
endif 

VIN-VIF-VIB 
IL=VIN/(2.0*RCUT) 
C 

Q  ************************************************************ 

c   *****  INITIAL  ITERATIVE  CONDITIONS  FOR  INNER  ITERATION  ***** 

Q  ************************************************************ 


c 


TRIG1  -  0 
TRIG2  -  0 
TRIG3  -  0 
TRIG4  -  0 
TRIG5  =  0 
TRIG6  -  0 

if  ((TIME  .ge.  TFPLUG)  .or.  (TIME  .eq.  TOPLUG))  then 
if  (float(DIRMl)*float(DIR)  .It.  0.)  then 

TOPLUG-TIME 

TFPLUG-T  0  PLUG+TDPLUG 

PLUG-1 
else 

TOPLUG-0 . 

TFPLUG-0 . 

PLUG-0 
endif 
endif 

call  TRANSW(TIME,REVTIM,BEMFA,BEMFB,BEMFC,BEMFT,VEMFA, 

+  VEMFB>VEMFC,VIB,VIF,IM(IMA,IMB,IMC,VN1,VN2,SW1, 

+  SW2 , SW3 , SW4 , SW5 , SW6 , THCON , THCON1 , RSAT , POSIT , DIR , 

+  VD1D,VD2D,VD3D,VD4D,VD5D,VD6D,RIN,R0UT,RS, 

+  REpAl,REQA2,REQBl,REQB2,REQCl,REQC2,IAB,IBC,ICA, 

+  PVAO , PVBO , PVCO , NODE , TRIG1 , TRIG2 , TRIG3 , TRIGA , 

+  TRIG5,TRIG6(RA,PLUG,VAIND,VBIND,VCIND) 

call  TCONSTdCQl, . 75-SWl,TTIME,NTIME,NTIM01.DELTIM,QlEXP) 
call  TCONST(ICQ2, . 75-SW2, TTIME,NTIME,NTIM02,DELTIM,Q2EXP) 
call  TCONST(ICQ3, . 75-SW3 , TTIME,NTIME,NTIM03 ,DELTIM,Q3EXP) 
call  TCONST(ICQ4, . 75-SW4 ,TTIME,NTIME,NTIM04 ,DELTIM,Q4EXP) 
call  TCONST(ICQ5, . 75-SW5, TTIME.NTIME.NTIM05 ,DELTIM,Q5EXP) 
call  TCONST(ICQ6, . 75-SW6,TTIME,NTIME,NTIM06,DELTIM,Q6EXP) 

call  LIMIT (RSAT, RCUT, 2. 0*RCUT*Q1EXP,RQ1) 
call  LIMIT (RSAT , RCUT , 2 . 0*RCUT*Q2EXP , RQ2 ) 
call  LIMIT (RSAT, RCUT, 2. 0*RCUT*Q3EXP,RQ3) 
call  LIMIT (RSAT , RCUT , 2 . 0*RCUT*Q4EXP , RQ4 ) 


191 


call  LIMIT(RSAT,RCUT,2.0*RCUT*Q5EXP,RQ5) 

call  LIMIT (RSAT , RCUT , 2 . 0*RCUT*Q6EXP , RQ6 ) 
C 

REQA1=RQ1*RD1/ (RQ1+RD1) 

REQA2=RQ2*RD2/ (RQ2+RD2 ) 

REQB1=RQ3*RD3/ (RQ3+RD3 ) 

REQB2=RQ4*RD4/ (RQ4+RD4 ) 

REQC1=RQ5*RD5/ (RQ5+RD5) 

REQC2=RQ6*RD6/ (RQ6+RD6 ) 
C 

ASIGN=ZA3 

BSIGH-ZB3 

CSIGN=ZC3 
C 

AHALF=0 

BHALF=0 

CHALF=0 
C 

Q  **************************** 

C   *****  START  INNER  LOOP  ***** 


do  650  NUMIN-1,20 
IMA-ZA3 
IMB-ZB3 
IMC-ZC3 

CALL  DERIV(DELTIM,NTIME,NTIM12,0.0,FREV2,IMA,YY2,YDM12,YD2, 
+  YDDM12.YDD2.DIADT) 

CALL  DERIVCDELTIM.NTIME.NTIMIS.O.O.PREVS.IMB.YYS.TOMIS.YDS, 
+  YDDM13.YDD3.DIBDT) 

CALL  DERIV(DELTIM , NTIME , NTIM14 ,0.0, PREV4 , IMC , YY4 , YDM14 , YD4 , 
+  YDDM14,YDD4,DICDT) 

VAIND-LA*DIADT 

VBIND-LA*DIBDT 

VCIND-LA*DICDT 

PVAO-IMA*(RA+RIN/2. )+VAIND 
PVBO-IMB*(RA+RIN/2. )+VBIND 
PVCC-IMC*(RA+RIN/2. 5+VCIND 

VAO-PVAO+VEMFA 
VBO-PVBO+VEMFB 
VCO-PVCO+VEMFC 

call  TRANSW(TIME,REVTIM,BEMFA,BEMFB,BEMFC,BEMFT,VEMFA, 

+  VEMFB,VEMFC,VIB,VIFfIM,IMA,IMB,IMC,VNl,VN2,SWl, 

+  SW2 , SW3 , SW4 , SW5 , SW6 , THCON , THCON1 , RSAT .POSIT , DIR , 

+  VD1D , VD2D , VD3D , VD4D , VD5D , VD6D , RIN , ROUT , RS , 

+  REQA1 , REQA2 , REQB1 , REQB2 , REQC1 , REQC2 , IAB , IBC , ICA , 

+  PVAO , PVBO , PVCO , NODE , TRIG1 , TRIG2 , TRIG3 , TRIG4 , 
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TRIG5,TRIG6,RA,PLUG,VAIND,VBIND,VCIND) 

call  LIMIT(-.7,800.0,VD1D,VD1D) 
call  LIMIT(-.7,800.0,VD2D,VD2D) 
call  LIMIT(-.7,800.0,VD3D,VD3D) 
call  LIMIT(-.7,800.0,VD4D,VD4D) 
call  LIMIT(-.7,800.0,VD5D,VD5D) 
call  LIMIK-. 7,800. 0,VD6D,VD6D) 

call  FCNSW(VD1D+ . 6 , RSAT , RSAT , RCUT , RDX1 ) 
call  FCNSW(VD2D+. 6, RSAT, RSAT, RCUT, RDX2) 
call  FCNSW(VD3D+. 6, RSAT, RSAT, RCUT, RDX3) 
call  FCNSW(VD4D+. 6, RSAT, RSAT, RCUT, RDX4) 
call  FCNSW(VD5D+. 6, RSAT, RSAT, RCUT, RDX5) 
call  FCNSW(VD6D+. 6 , RSAT , RSAT , RCUT ,RDX6) 

RD1-RDX1+RDADJ 
RD2-RDX2+RDADJ 
RD3-RDX3+RDADJ 
RD4-RDX4+RDADJ 
RD5-RDX5+RDADJ 
RD6-RDX6+RDADJ 

REQA1-RQ1*RD1/ (RQ1+RD1) 
REQA2=RQ2*RD2 / ( RQ2+RD2 ) 
REQB1-RQ3*RD3/ (RQ3+RD3) 
REQB2-RQ4*RD4 / (RQ4+RD4 ) 
REQC 1=RQ5*RD 5 / ( RQ5+RD5 ) 
REQC2-RQ6*RD6/ (RQ6+RD6) 

REQAS 1-REQA1+RS 1+ROUT / 2 . 
REQAS2=REQA2+RS2+ROUT / 2 . 
REQBS 1=REQB 1+RS 1+ROUT / 2 . 
REQBS2=REQB2+RS2+ROUT/2 . 
REC3CS 1-REC3C  1+RS  1+ROUT  /  2 . 
REQCS2-REQC2+RS2+ROUT/2 . 

VANTH-VN1*REQAS2/(REQAS1+REQAS2)+VN2*REQAS1/(REQAS1+REQAS2) 
VBNTH-VN1*REQBS2/ ( REQBS 1+REQBS2 )+VN2*REQBSl/ (REQBS1+REQBS2 ) 
VCNTH-VN1*REQCS2/ (REQCS1+REQCS2)+VN2*REQCS1/ (REQCS1+REQCS2) 

REQA-REQAS1*REQAS2/ ( REQAS 1+REQAS2) 
REQB-REQBS1*REQBS2/ ( REQBS 1+REQBS2) 
REQC-REQCS1*REQCS2/ (REQCS1+REQCS2) 

REQAB-2 . 0*RA+1 . 0*RIN+REQA+REQB 
REQBC=2 . 0*RA+1 . 0*RIN+REQB+REQC 
REQCA=2 . 0*RA+1 . 0*RIN+REQC+REQA 

IAB-CVANTH-VBNTH ) /REQAB 
IBC=(VBNTH-VCNTH) /REQBC 
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ICA«(VCNTH-VANTH ) /REQCA 


ABTAU-2 . 0*LA/REQAB 
BCTAU-2 . 0*LA/REQBC 
CATAU-2 . 0*LA/ REQCA 

***  DISCHARGE  OF  PHASE  CURRENTS  (FREEWHEELING  DIODES)  *** 
if  (PLUG  .eq.  1)  then 

IAB=»0. 

IBC=0 . 

ICA=0 . 
elseif  ((POSIT  .eq.  1)  .or.  (POSIT  .eq.  4))  then 

IAB-0. 

ICA=-0 . 
elseif  ((POSIT  .eq.  2)  .or.  (POSIT  .eq.  5))  then 

IBC=0 . 

ICA=0 . 
elseif  ((POSIT  .eq.  3)  .or.  (POSIT  .eq.  6))  then 

IAB-0. 

IBC-0 . 
end  if 


call  TCONST ( ICIMAB . IAB , ABTAU , NTIME , NTIM32 , DELTIM , IMAB ) 
call  TCONST ( ICIMBC , IBC , BCTAU , NTIME , NTIM33 , DELTIM , IMBC ) 
c all  TCONST ( ICIMCA , ICA , CATAU , NTIME , NTIM3 A , DELTIM , IMCA ) 

FA3-IMAB-IMCA-ZA3 
FB3-IMBC-IMAB-ZB3 
FC3-IMCA-IMBC-ZC3 

IMA-IMAB-IMCA 
IMB-IMBC-IMAB 
IMC=IMCA-IMBC 

IM-( abs ( IMA)+abs ( 1MB )+abs ( IMC ) ) /2. 


*****  MODIFIED  LINEAR  INTERPOLATION  ***** 
***************************************** 

if  (NTIME  .eq.  1)  go  to  550 

if  (NUMIN  .eq.  1)  then 
ZA1-ZA3 
ZB1-ZB3 
ZC1=ZC3 
FA1=FA3 
FB1-FB3 
FC1-FC3 
ZA3-IMA 
ZB3-IMB 
ZC3-IMC 
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eq. 

0 

eq. 

0 

eq. 

0 

ne. 

0 

ne. 

0 

ne. 

0 

)  FA2-.5*FA2+l.E-6 

)  FB2=.5*FB2+l.E-6 

)  FC2-.5*FC2+l.E-6 

)  ZA3=ZA2-FA2*(ZA1-ZA2)/(FA1-FA2) 

)  ZB3-ZB2-FB2*(ZB1-ZB2)/(FB1-FB2) 

0.)  ZC3=ZC2-FC2*(ZC1-ZC2)/(FC1-FC2) 


go  to  650 
elseif  (NUMIN  .eq.  2)  then 
ZA2=ZA3 
ZB2=ZB3 
ZC2-ZC3 
FA2-FA3 
FB2-FB3 
FC2-FC3 
ASIGN=FA3 
BSIGN-FB3 
CSIGN-FC3 
if  (abs(FAl-FA2) 
if  (abs(FBl-FB2) 
if  (abs(FCl-FC2) 
if  (abs(FAl-FA2) 
if  (abs(FBl-FB2) 
if  (abs(FCl-FC2) 
go  to  650 
else 
"A"  Leg  .  .  . 

if  (FA3  .ne.  0. )  then 
if  (FA1*FA2  .It.  0.)  then 
if  (FA1*FA3  .It.  0.)  then 
ZA2=ZA3 
FA2=FA3 

if  (FA3*ASIGN  .gt.  0.)  FA1-FA1/2. 
ZA3=ZA2-FA2* ( ZA2-ZA1 ) / ( FA2-FA1 ) 
elseif  (FA1*FA3  .gt.  0.)  then 
ZA1-ZA3 
FA1-FA3 

if  (FA3*ASIGN  .gt.  0.)  FA2-FA2/2. 
ZA3-ZA2-FA2* ( ZA2- ZA1 ) / ( FA2-FA1 ) 
endif 
elseif  (FA1*FA2  .gt.  0.)  then 
.Cautious  forward  iteration  using  halving  and  checking  scheme  in 
unbracketed  region. 

0)    then 


eq. 


if  (AHALF 
ZA1-ZA2 
ZA2-ZA3 
FA1-FA2 
FA2=FA3 

ZA3-ZAl+( ZA2-ZA1 ) /2 . 
AHALF- 1 
elseif    (ABALF    .eq.    1)    then 
if   (FA1*FA3    .It.    0.)    then 

AHALF-0 

ZA2-ZA3 

FA2-FA3 

ZA3-ZA2-FA2* ( ZA2-ZA1 ) / (FA2-FA1 ) 
elseif    (FA1*FA3    .gt.    0.)    then 

AHALF=0 
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ZA1=ZA2 
ZA2=ZA3 
FA1-FA2 
FA2-FA3 

if  (abs(FA2-FAl)  .eq.  0.)  FA2=FA2/2. 

if  (abs(FA2-FAl).ne.O.)  ZA3-ZA2-FA2*(ZA2-ZA1)/ (FA2-FA1) 
end  if 
end  if 
elseif  (FA1*FA2  .eq.  0.)  then 
ZA1=ZA2 
ZA2=2A3 
FA1-FA2 
FA2-FA3 

if  (abs(FA2-FAl)  .eq.  0.)  FA2-FA2/2. 

if  (abs(FA2-FAl)  .ne.  0.)  2A3-ZA2-FA2*(ZA2-ZA1)/ (FA2-FA1) 
endif 
end  if 
C  . . .  "B"  Leg  . .  . 

if  (FB3  .ne.  0.)  then 
if  (FB1*FB2  .It.  0.)  then 
if  (FB1*FB3  .It.  0. )  then 
ZB2=ZB3 
FB2=FB3 

if  (FB3*BSIGN  .gt.  0.)  FB1-FB1/2. 
ZB3-ZB2-FB2*(ZB2-ZB1)/(FB2-FB1) 
elseif  (FB1*FB3  .gt.  0.)  then 
ZB1-ZB3 
FB1-FB3 

if  (FB3*BSIGN  .gt.  0.)  FB2=FB2/2. 
ZB3-ZB2-FB2*(ZB2-ZB1)/(FB2-FB1) 
endif 
elseif  (FB1*FB2  .gt.  0.)  then 
C  . . .Cautious  forward  iteration  using  halving  and  checking  scheme  in 
C    unbracketed  region. 

if  (BHALF  .eq.  0)  then 
ZB1-ZB2 
ZB2-ZB3 
FB1-FB2 
FB2-FB3 

ZB3-ZBl+(ZB2-ZBl)/2. 
BBALF-1 
elseif  (BHALF  .eq.  1)  then 
if  (FB1*FB3  .It.  0.)  then 
BHALF=»0 
ZB2-ZB3 
FB2=FB3 

ZB3-ZB2-FB2* ( ZB2-ZB1 ) / (FB2-FB1) 
elseif  (FB1*FB3  .gt.  0.)  then 
BHALF-0 
ZB1-ZB2 
ZB2=ZB3 
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FB1=FB2 
FB2-FB3 

if  (abs(FB2-FBl)  .eq.  0.)  FB2=FB2/2. 

if  (abs(FB2-FBl).ne.O.)  ZB3=ZB2-FB2*(ZB2-ZB1) / (FB2-FB1) 
endif 
end  if 
eiseif  (FB1*FB2  .eq.  0.)  then 
ZB1-ZB2 
ZB2=ZB3 
FB1=FB2 
FB2=FB3 

if  (abs(FB2-FBl)  .eq.  0.)  FB2=FB2/2. 

if  (abs(FB2-FBl)  .ne.  0.)  ZB3=ZB2-FB2*(ZB2-ZB1)/ (FB2-FB1) 
endif 
endif 
C  . . .  "C"  Leg  . .  . 

if  (FC3  .ne.  0.)  then 
if  (FC1*FC2  .It.  0.)  then 
if  (FC1*FC3  .It.  0.)  then 
ZC2-ZC3 
FC2=FC3 

if  (FC3*CSIGN  .gt.  0.)  FCl=FCl/2. 
ZC3=ZC2-FC2* ( ZC2-ZC1 ) / (FC2-FC1 ) 
eiseif  (FC1*FC3  .gt.  0.)  then 
ZC1-ZC3 
FC1-FC3 

if  (FC3*CSIGN  .gt.  0.)  FC2=FC2/2. 
ZC3-ZC2-FC2*(ZC2-ZC1)/(FC2-FC1) 
endif 
'eiseif  (FC1*FC2  .gt.  0.)  then 
C  . . .Cautious  forward  iteration  using  halving  and  checking  scheme  in 
C    unbracketed  region. 

if  (CHALF  .eq.  0)  then 
ZC1-ZC2 
ZC2-ZC3 
FC1-FC2 
FC2-FC3 

ZC3-ZCl+( ZC2-ZC1 ) /2 . 
CHALF- 1 
eiseif  (CHALF  .eq.  1)  then 
if  (FC1*FC3  .It.  0. )  then 
CHALF=0 
ZC2-ZC3 
FC2=FC3 

ZC3=ZC2-FC2* ( ZC2-ZC1 ) / (FC2-FC1 ) 
eiseif  (FC1*FC3  .gt.  0.)  then 
CHALF=0 
ZC1=ZC2 
ZC2-ZC3 
FC1-FC2 
FC2-FC3 
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if  (abs(FC2-FCl)  .eq.  0.)  FC2=FC2/2. 

if  (abs(FC2-FCl).ne.O.)  ZC3=ZC2-FC2*(ZC2-ZC1)/ (FC2-FC1) 
end  if 
endif 
elseif  (FC1*FC2  .eq.  0.)  then 
ZC1-ZC2 
ZC2=ZC3 
FC1-FC2 
FC2-FC3 

if  (abs(FC2-FCl)  .eq.  0.)  FC2=FC2/2. 

if  (abs(FC2-FCl)  .ne.  0.)  ZC3=ZC2-FC2*(ZC2-ZC1) / (FC2-FC1) 
endif 
endif 
endif 
C 

ASIGN=FA3 
BSIGN=FB3 
CSIGN=FC3 
C 

if    (abs(ZA3)    .gt.    l.E-4)   RERRZA=abs(FA3/ZA3) 
if    (abs(ZA3)    .le.    l.E-4)   RERRZA-abs(FA3) 
if    (abs(ZB3)    .gt.    l.E-4)   RERRZB«abs(FB3/ZB3) 
if    (abs(ZB3)    .le.    l.E-4)   RERRZB-abs (FB3) 
if    (abs(ZC3)    .gt.    l.E-4)   R£RRZC=abs(FC3/ZC3) 
if    (abs(ZC3)    .le.    l.E-4)   RERRZC-abs(FC3) 
C 

if    ((RERRZA    .It.    l.E-6)    .and.    (RERRZB    .It.    l.E-6)    .and. 
+  (RERRZC    .It.    l.E-6))    go   to   550 

C 

650  continue 

c    ***************************** 

C    *****  End  of  inner  loop  ***** 
c    ***************************** 

c 

call  GOTOXY(23,12) 
write(*,651)  TIME 

651  formate lx, 'Stiff  Phase  Current  Characteristics  at  ',F8.7, 
+       '  seconds' ) 

C 

550  TA-IMA*KT*BEMFA/KK3 
TB-IMB*KT*BEMFB /KK3 
TC=IMC*KT*BEMFC/KK3 
TM-TA+TB+TC 

call  TCONSTUCTMF.TM, . 005 ,NTIME,NTIM47 , DELTIM.TMFi 
TMM=KT*IM 
TBM-BM*WM 
VKBWM=KB*WM 
C 

if    <WM    .It.    0.0)    go   to    180 
TN1-TM-TL 
go   to    185 
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180     TN1-TM+TL 
185     continue 
TN2=TN1/B 
C 

WM1=WM 
THETA1-THETA 

call  TCONST(WM0,TN2,A2,NTIME,NTIM48,DELTIM,WM) 
call  INTGRL(NTIME , NTIM23 , DELTIM, THETAO , PREV7 , WM , CURV7 , 
+  HOLD3.PTHETA) 

C 

THETA=PTRETA 
F3=THETA-THETA1 

Q  ***************************************** 

c    *****  MODIFIED  LINEAR  INTERPOLATION  ***** 
C    ***************************************** 

c 

if  (NTIME  .eq.  1)  go  to  601 
C 

if  (NUMIT  .eq.  1)  then 
X1=X3 
F1-F3 
X3-THETA 
go  to  500 
elseif  (NUMIT  .eq.  2)  then 
X2-X3 
F2-F3 

if  (abs(F2-Fl)  .eq.  0.)  F2-. 5*F2+l.E-6 
if  (abs(F2-Fl)  .ne.  0.)  X3-X2-F2*(X2-X1) / (F2-F1) 
TSIGN-F3 
go  to  500 
elseif  (F3  .ne.  0.)  then 
if  (F1*F2  .It.  0.)  then 
if  (F1*F3  .It.  0.)  then 
X2-X3 
F2-F3 

if  (F3*TSIGN  .gt.  0.)  Fl=Fl/2. 
X3-X2-F2*(X2-X1)/(F2-F1) 
elseif  (F1*F3  .gt.  0.)  then 
X1-X3 
F1-F3 

if  (F3*TSIGN  .gt.  0.)  F2=F2/2. 
X3-X2-F2*(X2-X1)/(F2-F1) 
endlf 
elseif  (F1*F2  .gt.  0.)  then 
C  . . .Cautious  forward  iteration  using  halving  and  checking  scheme  in 
C    unbracketed  region. 

if  (HALF  .eq.  0)  then 
X1-X2 
X2-X3 
F1-F2 
F2=F3 
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X3=Xl+(X2-Xl)/2. 

HALF-1 
elseif  (HALF  .eq.  1)  then 
if  (F1*F3  .It.  0.)  then 
HALF-0 
X2-X3 
F2-F3 

X3=X2-F2* (X2-X1 ) / (F2-F1 ) 
elseif  (F1*F3  .gt.  0.)  then 
HALF-0 
X1=X2 
X2-X3 
F1=F2 
F2=F3 

if    (abs(F2-Fl)    .eq.    0.)    F2-F2/2. 
if    (abs(F2-Fl)    .ne.    0.)   X3=X2-F2*(X2-X1)/ (F2-F1) 
endif 
end  if 
elseif    (F1*F2    .eq.    0.)    then 
X1-X2 
X2-OC3 
F1=F2 
F2-F3 

if    (abs(F2-Fl)    .eq.    0.)   F2=F2/2. 
if    (abs(F2-Fl)    .ne.    0.)   X3=X2-F2*(X2-X1) / (F2-F1) 
endif 
endif 
C 

if    (abs(X3)    .gt.    l.E-4)   RELERR«abs(F3/X3) 
if    (abs(X3)    .le.    l.E-4)   RELERR-abs(F3) 
C 

if    (RELERR    .It.    l.E-6)    go  to   601 
500   continue 

call  GOTOXY(24,15) 
write(*,652)   TIME 
652   format (Ix, 'FAILED  Convergence  of  Coiter  Loop  at    ',F8.7,    '    seconds') 
C 

601  WMRFM»WM*30./PI 

THDEG-THETA*180 . 0/PI 
X3=THETA+WM*DELTIM 
THETAF-REDRAT*THETA*180 . /PI 
OMEGAF=REDRAT*WM*180 . /PI 
PREIMA=ZA3+. 5*DIADT*DELTIM 
PREIMB=ZB3+ . 5*DIBDT*DELTIM 
PREIMC=»ZC3+ .  5*DICDT*DELTIM 
ZA3-PREIMA 
ZB3=PREIMB 
ZC3-PREIMC 
DIRM1-DIR 
C 
c  a*********.*************** 
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C    *****  End  outer  loop  ***** 
q  ************************** 

C 

C   ...  Generate  Plotting  Arrays  . . . 
if  (TIME  .ge.  BEGTIM)  then 
NCTR-NCTR+1 

if  ((mod(NCTR,SIM2PL)  .eq.  0)  .or.  (NCTR  .eq.  1))  then 
NPTS=NPTS+1 
C   ...   Output  data  to  file  for  future  retrieval  and  plotting  . 
C 

XTIME(NPTS)=TIME 


write (A, 1200)  T IME.THETAF, ORDER, OMEGAF, NODE, PLUG 
write (5, 1210)  IM, IMA, 1MB, IMC.TM.TMF 
write(6,1220)  VD1D,VD2D,VD3D, VDAD, VD5D.VD6D 
wr ite ( 7 , 1230 )  SW1 , SW2 , SW3 , SWA , SW5 , SW6 

1200     format(5F15.7,3X,I3) 

1210     format(6F15.7) 

1220     format(6F15.7) 

1230     fonnat(6F5.2) 
endif 
endif 


100  CONTINUE 

close(A,STATUS-'KEEP') 
close(5,STATUS-'KEEP' ) 
close(6,STATUS-'KEEP' ) 
close (7, STATUS- 'KEEP' ) 

****************************** 

*****  plotting  selection  ***** 
****************************** 

Clear  Screen  &  Home  Cursor  *** 
A00  call  CLRSCR 


write(*,1305) 
read(*, '(A)')  DISOPT 


,eq.  'p')  .or.  (DISOPT  .eq.  'P'))  then 


if  ((DISOPT  .eq.  'm' )  .or.  (DISOPT  .eq.  'M'))  then 

MODEL-99 

IOPORT-99 
elseif  ((DISOPT 

MODEL-PMODEL 

IOPORT-1 
.  Ioport-9600  is  COM1  . . . 
.  Ioport-9650  is  COM2  . . . 

if  ((MODEL  .eq.  20)  .or 
elseif  ((DISOPT  .eq.  'r') 

GO  TO  13 
elseif  ((DISOPT  .eq.  *w' ) 


(MODEL  .eq.  30))  IOPORT-9650 
.or.  (DISOPT  .eq.  'R'))  then 

.or.  (DISOPT  .eq.  'W'))  then 
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c 

Q  ******************************************** 

C     *****  Output  Simulation  Specs  to  Printer  *** 
q  ******************************************** 

C 

call  PRNOUT (BEGTIM , FINTIM , PTSPLT , MAXITS , SIM2PL , DELTIM , NTERMS , 
+  EO , EDOTO , TYPE , STPMAG , RSLOPE , SINAMP , SINFRQ , SINPHA , 

+  NLCHAR , DBAND , PERIOD , KPWM , RIN , ROUT , RDAD  J , KTM , KBM , 

+  KV,KP,RA,LA,BM,BL,JM,JL,RSAT,RCUT,TTIME,RS,THADV, 

+  TDPLUG) 

C 

go  to  400 
C 

elseif  ((DISOPT  .eq.  's')  .or.  (DISOPT  .eq.  'S'))  then 
C 

Q  **************************************** 

C     ***  OPEN/WRITE/CLOSE  INPUT  DATA  FILE  *** 
c     **************************************** 

c 

open ( 2 , FILE- ' MOTOR . INP ' , STATUS- ' OLD ' , ACCESS- ' SEQUENTIAL ' ) 
write (2, 1000)  PMODEL, PRTCHR,RIN,ROUT,RDADJ 
write(2,1020)  BEGTIM, FINTIM, PTSPLT, MAXITS, SIM2PL 
write(2,1022)  KPWM, KV.E0, EDOTO, TTIME.XORG, YORG 
write(2,1024)  RS , RSAT , JL , BL , KTM 
write(2,1026)  JM, RA, LA, KBM, THADV, TDPLUG 
write(2,1028)  BM.KP, PERIOD, DBAND, KA 
write (2 , 1030 )  TYPE , RCUT , STPMAG , RSLOPE 
write (2, 1032)  SINAMP, SINFRQ, SINPHA, DRIVE 
close(2,STATUS-'KEEP' ) 
C 

go  to  400 
C 

elseif  ((DISOPT  .eq.  "Q' )  .or.  (DISOPT  .eq.  'q'))  then 

GO  TO  460 
else 

go  to  400 
end  if 
C 

call  DISPLA (XORG , YORG , DISOPT , PRTCHR , ELEMNT , DRIVE , XTIME ) 


go  to  400 

460  continue 

c 

c 

***   I/O  Statements 

c 

4  format(//////,25X,'***  BRUSHLESS  DC  MOTOR  SIMULATION  ***',//, 
+  25X,'         Vincent  S.  Rossitto',/, 

+  25x,'      Naval  Postgraduate  School',//////) 

5   format(32X, '***  MAIN  MENU  ***',//, 

+       20X,'[H] >  HARDWARE  Configuration  Menu',/, 
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+       20X,'[M] >  MOTOR  Parameter  Menu',/, 

+       20X,'[N] >  NON-LINEAR  Element  Selection  Menu',/, 

+       20X,'[0] >  OPTIONS  for  Simulation',/, 

+       20X,'[C] >  COMMAND  Input  Selection  Menu',/, 

+       20X,'[S] >  SAVE  All  Changes',/, 

+       20X,'[R] >  RUN  Simulation  Program',/, 

+       20X,'[Q] >  QUIT  the  Program',//, 

+        8X, 'ENTER  SELECTION >',\) 

C 

105     format(30X, '***  HARDWARE  MENU  ***',//, 

+       20X, ' [P] >  PRINTER/ PLOTTER  configuration  change',/, 

+       20X,'[Q] >  QUIT  THIS  MENU',//, 

+         8X, 'ENTER  SELECTION >' , \ ) 

1000  format(lX,I3,2X,A51,2X,3F15.7) 

1020  format(lX,4F15.7,lX,I3) 

1022  format(lX,7F15.7) 

1024  format(lX,5F15.7) 

1026  format(lX,6F15.7) 

1028  formate  IX, 5F15. 7) 

1030  format(lX,A15,3F15.7) 

1032  format(lX,3F15.7,lX,A3) 

2000  format (IX, 'END  OF  FILE') 
C 

240   formate 12X, ****  SIMULATION  OPTIONS  MENU  ***',//, 

+  1X.F15.7.1X, ' [BEGTIM]   Start  Time  of  Plotting  Window',/, 

+  1X,F15.7,1X, * [FINTIM]   Stop  Time  of  Plotting  Window',/, 

+  1X,F15.7,1X, ' [PTSPLT]   Points  to  be  Plotted  per  Curve',/, 

+  1X.F15.7.1X, ' [MAXITS]   Max  Number  of  Simulation  Iterations',/, 

+  13X.I3.1X,   '[SIM2PL]   Ratio:  Points  Simulated/Plotted',/, 

+  1X,F15.7,1X,' [E0]      Initial  Fin  Position  ERROR  (deg)',/, 

+  1X,F15.7,1X, ' [EDOT0]    Initial  Fin  Velocity  ERROR  (deg/s)',/, 

+  1X,F15.7,1X, ' [XORG]    X  Coordinate  of  Plotting  Origin*,/, 

+  1X,F15.7,1X,'[Y0RG]     Y  Coordinate  of  Plotting  Origin',/, 

+  13X,A3,1X,   '[DRIVE]    Drive  (d: )  for  Virtual  Memory' ,/ , 

+  17X,'[Q]       QUIT  THIS  MENU',///, 

+  1SX, 'Computed  simulation  step  size  >  ',F9.8,  'seconds',/, 

+  15X, 'Computed  total  number  of  steps >  ',16,//, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  — >  \\) 
C 

245   format (12X,****  COMMAND  INPUT  SELECTION  MENU  ****,//, 
+  1X.A15.1X,' [TYPE]     STEP,  RAMP,  or  SINE  Response',/, 
+  1X.F15.7.1X, ' [STPMAG]   Commanded  Position  for  STEP  Response',/, 
+  1X,F15.7,1X,* [RSLOPE]   Slope  of  RAMP  Function',/, 
+  1X.F15.7.1X, ' [SINAMP]   Amplitude  of  SINE  Function',/, 
+  1X.F15.7.1X, '[SINFRQ]   Frequency  (deg/sec)  of  SINE  Function',/, 
+  1X.F15.7.1X,' [SINPHA]   Phase  Angle  (deg)  of  SINE  Function',/, 
+  17X,'[Q]       QUIT  THIS  MENU*,///, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  *,\) 

C 

270   format(///,8X,'***  NON-LINEAR  ELEMENT  SELECTION  ***',//, 
+  17X,         ' [R]    Relay  (Bang-Bang)',/, 
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+  17X,        '[P]     Pulse  Width  Modulator',/, 

+  1X,F15.7,1X, ' [KV]    Velocity  Feedback  Constant',/, 

+  1X.F15.7.1X, ' [KP]    Position  Feedback  Constant',/, 

+  17X,        *[Q]     QUIT  THIS  MENU/RETURN  TO  MAIN  MENU',//, 

+  IX, 'Enter  Selection  >  ',\) 

C 

272   formatUOX,  'CURRENT  SELECTION  —  >  \A30) 
C 
280   format( ///,8X,'***  SATURATING  AMPLIFIER  SPECIFICATIONS  ***',//, 
+  1X.F15.7, IX, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 
+  1X.F15.7.1X, ' [KA]      Amplifier  Gain' ,/, 
+  17X,'[Q]        QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  >  ',\) 

C 
290   format(///,15X,'***  RELAY  SPECIFICATIONS  ***',//, 

+  1X.F15.7.1X, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 
+  17X,'[Q]       QUIT  THIS  MENU',//, 
+  IX, 'Enter  the  selection  (UPPERCASE)  — ->  ',\) 
C 
300   format(///,5X,'***  PULSE  WIDTH  MODULATOR  SPECIFICATIONS  ***',//, 
+  1X,F15.7,1X, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 
+  1X,F15.7,1X,' [PERIOD]   Period  of  PWM  Reference  Cycle(sec) ' , / , 
+  1X,F15.7,1X,*[KPWM]     PWM  Amplifier  Gain',/, 
+  17X,'[Q]       QUIT  THIS  MENU*,//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  >  *,\) 

C 
1305  FORMAT(/////,2X, 'Display  options:',/, 
+  5X,* [M]  MONITOR',/, 

+  5X,'[P]  PRINTER' ,/, 

+  5X,'[R]  RETURN  TO  START-UP  MENU  (RE-INITIALIZE)',/, 

+  5X,'[W]  WRITE  SIMULATION  SPECIFICATIONS  TO  PRINTER',/, 

+  5X,'[S]  SAVE  SIMULATION  SPECIFICATIONS  TO  DISK',/, 

+  5X,'[Q]  QUIT  THE  PROGRAM',//, 

+  2X, 'Enter  selection  [M,P,R,W,S,Q]  >  '  ,\) 

C 
1500  format(lX,I3,2X,A50) 
STOP 
END 

C  BLDCM2A.FOR   (subroutines  PRNOPT,MOTPAR,DISPLA,PRNOUT) 

C  These  subroutines  are  compiled  as  a  group,  but  separately  from 

C  BLDCM1  &  BLDCM2A  due  to  size  limitations.  Subroutines  must  be 

C  linked  together. 

C 

C  Last  Revision  -->  04  April  1987 

C  LT  Vincent  S.  Rossitto,  USN 

C 

Q  ************************************** 

C    ***  PRINTER/ PLOTTER  SELECTION  MENU  *** 
c    ************************************** 

C 
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C     Provides  user  interface  for  selection  of  Printer  for  output 
C     device. 


C 


subroutine  PRNOPT ( PMODEL , PRTSEL, PRTCHR) 
implicit  REAL*4  (A-Z) 
integer*2  PMODEL 
character*6  PRTSEL 
character*51  PRTCHR 

131        call  CLRSCR 
write(*,130) 
read(*,'(A)' )  PRTSEL 

if  (PRTSEL  .eq.  *0')  then 

PRTCHR-'Epson  FX-80  Printer,  single  density' 

PMODEL=0 
elseif  (PRTSEL  .eq.  *  1*)  then 

PRTCHR-'Epson  FX-80  Printer,  double  density' 

PMODEL- 1 
elseif  (PRTSEL  .eq.  '2')  then 

PRTCHR-'Epson  FX-80  Printer,  dble  spd.dual  density' 

PMODEL-2 
elseif  (PRTSEL  .eq.  '3')  then 

PRTCHR-'Epson  FX-80  Printer,  quad  density' 

PMODEL- 3 
elseif  (PRTSEL  .eq.  '4')  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  I' 

PMODEL-4 
elseif  (PRTSEL  .eq.  '5')  then 

PRTCHR-'Epson  FX-80  Printer,  plotter  graphics' 

PMODEL-5 
elseif  (PRTSEL  .eq.  '6')  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  II' 

PMODEL-6 
elseif  (PRTSEL  .eq.  '10')  then 

PRTCHR-'Epson  FX-100  Printer,  single  density' 

PMODEL-7 
elseif  (PRTSEL  .eq.  '11')  then 

PRTCHR-'Epson  FX-100  Printer,  double  density' 

PMODEL- 11 
elseif  (PRTSEL  .eq.  '12')  then 

PRTCHR-'Epson  FX-100  Printer,  dble  spd.dual  density' 

PMODEL- 12 
elseif  (PRTSEL  .eq.  '13')  then 

PRTCHR-'Epson  FX-100  Printer,  quad  density' 

PMODEL- 13 
elseif  (PRTSEL  .eq.  '14')  then 

PRTCHR-'Epson  FX-100  Printer,  CRT  Graphics  I' 

PMODEL- 14 
elseif  (PRTSEL  .eq.  '15')  then 

PRTCHR-'Epson  FX-100  Printer,  plotter  graphics' 
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PM0DEL=15 
elseif  (PRTSEL  .eq.  '16')  then 

PRTCHR='Epson  FX-100  Printer,  CRT  Graphics  II' 

PMODEL=16 
elseif  (PRTSEL  .eq.  '20')  then 

PRTCHR='HP  7470A  Graphics  Plotter' 

PMODEL-20 
elseif  (PRTSEL  .eq.  '30')  then 

PRTCHR='HP  7475A  Graphics  Plotter' 

PMODEL-30 
elseif  (PRTSEL  .eq.  '60')  then 


PRTCHR='HP  2686A  Laser  Jet  Printer' 
PMODEL-60 
C 
C   ...  Quit  the  Printer  Menu  . . . 

elseif  ((PRTSEL  .eq.  'Q')  .or.  (PRTSEL  .eq.  'q'))  then 

go  to  101 
else 

go  to  131 
endif 
101        continue 
C 
130  FORMAT (24X,'***  PRINTER  OPTIONS  MENU  ***',//, 

+   15X,'[0]  — >  Epson  FX-80  Printer,  single  density',/, 

+   15X,'[1]  — >  Epson  FX-80  Printer,  double  density',/, 

+   15X,'[2]  -->  Epson  FX-80  Printer,  dble  spd.dual  density',/, 

+  15X,'[3]  — >  Epson  FX-80  Printer,  quad  density',/, 

+   15X,'[4]  — >  Epson  FX-80  Printer,  CRT  Graphics  I',/, 

+  15X,'[5)  -->  Epson  FX-80  Printer,  plotter  graphics',/, 

+   15X,'[6]  -->  Epson  FX-80  Printer,  CRT  Graphics  11',/, 

+   15X,'[10]  ->  Epson  FX-100  Printer,  single  density',/, 

+  15X,'[11]  ->  Epson  FX-100  Printer,  double  density',/, 

+   15X,'[12]  ->  Epson  FX-100  Printer,  dble  spd.dual  density',/, 

+   15X,'[13]  ->  Epson  FX-100  Printer,  quad  density',/, 

+   15X,'[14]  ->  Epson  FX-100  Printer,  CRT  Graphics  I',/, 

+   15X,'[15]  ->  Epson  FX-100  Printer,  plotter  graphics',/, 

+   15X,*[16]  ->  Epson  FX-100  Printer,  CRT  Graphics  11',/, 

+   15X,'[20]  ->  HP  7470A  Graphics  Plotter',/, 

+   15X,'[30]  ->  HP  7A75A  Graphics  Plotter',/, 

+   15X,'[60]  ->  HP  2686A  Laser  Jet  Printer  (NPS  installation)',/, 

+   15X,'[Q]  — >   QUIT  THIS  MENU* ,//, 

+   3X, 'Enter  Printer  Selection  Integer  or  Q  to  QUIT  >  ',\) 

return 
end 

C 

c   ***************************************** 

C   ****  Motor  Parameter  Input  Subroutine  *** 
c   ***************************************** 

C 

subroutine  MOTPAR(KTM,KBM,RIN,ROUT,RDADJ,RA,LA,BM,BL, JM, JL, 
+  RSAT , RCUT , TTIME , RS , THADV , TDPLUG ) 
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implicit  REAL(A-Z) 
character*6  ANS21 
C 
201     call  CLRSCR 

write(*,230)  KTM,KBM,RIN,ROUT,RDADJ,RA,LA,BM,BL, JM, JL, 
+  RSAT,RCUT,TTIME,RS,THADV,TDPLUG 

read(*,'(A)*)  ANS21 
C 

if  (ANS21  .eq.  'KTM' )  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  KTM-->  ' 

read(*,*)  KTM 

go  to  201 
elseif  (ANS21  .eg.  'KBM* )  then 

call  GOT0XY(24,l) 

write (*,' (A\)')'Enter  a  REAL  value  for  KBM-->  ' 

read(*,*)  KBM 

go  to  201 
elseif  (ANS21  .eq.  'RIN' )  then 

call  GOTOXY(24,l) 

write (*,'(A\)*)'Enter  a  REAL  value  for  RIN— >  ' 

read(*,*)  RIN 

go  to  201 
elseif  (ANS21  .eq.  'ROUT')  then 

call  GOTOXY(24,l) 

write(*,*(A\)')*Enter  a  REAL  value  for  ROUT— >  ' 

read(*,*)  ROUT 

go  to  201 
elseif  (ANS21  .eq.  'RDADJ' )  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  RDADJ— >  ' 

read(*,*)  RDADJ 

go  to  201 
elseif  (ANS21  .eq.  'RA' )  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  RA — >  ' 

read(*,*)  RA 

go  to  201 
elseif  (ANS21  .eq.  'LA')  then 

call  GOTOXY(24,l) 

write(*, * (A\ ) ' ) 'Enter  a  REAL  value  for  LA— >  ' 

read(*,*)  LA 

go  to  201 
elseif  (ANS21  .eq.  'BM' )  then 

call  GOT0XY(24,l) 

write(*,*(A\)') 'Enter  a  REAL  value  for  BM— >  ' 

read(*,*)  BM 

go  to  201 
elseif  (ANS21  .eq.  'BL* )  then 

call  GOTOXY(24,l) 

write (*,'(A\)*) 'Enter  a  REAL  value  for  BL— >  ' 
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read(*,*)  BL 

go  to  201 
eLseif  (ANS21  .eq.  'JM')  then 

call  GOTOXY(24,l) 
write (*, ' (A\)' ) 'Enter  a  REAL  value  for  JM— >  ' 

read(*,*)  JM 

go  to  201 
elseif  (ANS21  ,eq.  'JL')  then 

call  GOTOXY(2<.,1) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  JL-->  ' 

read(*,*)  JL 
'  go  to  201 
elseif  (ANS21  .eq.  'RSAT')  then 

call  GOTOXY(24,l) 

write(*( ' (A\)' ) 'Enter  a  REAL  value  for  RSAT-->  ' 

read(*,*)  RSAT 

go  to  201 
elseif  (ANS21  .eq.  'RCUT')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  RCUT-->  ' 

read(*,*)  RCUT 

go  to  201 
elseif  (ANS21  .eq.  'TTIME')  then 

call  GOT0XY(24,l) 

write(*( * (A\)' )' Enter  a  REAL  value  for  TTIME-->  ' 

read(*,*)  TTIME 

go  to  201 
elseif  (ANS21  .eq.  'RS' )  then 

call  GOTOXY(24,l) 

write ( *,' (A\ ) ' )* Enter  a  REAL  value  for  RS-->  ' 

read(*,*)  RS 

go  to  201 
elseif  (ANS21  .eq.  'THADV')  then 

call  GOTOXY(24,l) 

write(*,'(A\)' ) 'Enter  a  REAL  value  for  THADV— >  ' 

read(*,*)  THADV 

go  to  201 
elseif  (ANS21  .eq.  'TDPLUG* )  then 

call  GOTOXY(24,l) 

write (*,' (A\)* ) 'Enter  a  REAL  value  for  TDPLUG— >  ' 

read(*,*)  TDPLUG 

go  to  201 
C   ...  Quit  Motor  Parameters  Menu  . . . 
elseif  (ANS21  .eq.  'Q')  then 

go  to  1 
else 

go  to  201 
end  if 
1     continue 
C 
230   fonnatUOX,  'MOTOR  PARAMETER  SELECTION  MENU',//, 
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+  1X,F15.7,1X,'[KTM] 
+  1X,F15.7,1X,'[KBM] 
+  1X,F15.7,1X,* [RIN] 
+  1X,F15.7,1X,' [ROUT] 
+  1X,F15.7,1X,' [RDADJ] 
+  1X,F15.7,1X,* [RA) 
+  1X,F15.7,1X,' [LA] 
+  1X.F15.7.1X, '[BM] 
+  1X,F15.7,1X,' [BL] 
+  1X,F15.7,1X,* [JM] 
+  1X,F15.7,1X,*[JL] 
+  lX,F15.7flX,' [RSAT] 
+  1X,F15.7,1X,' [RCUT] 
+  1X,F15.7,1X,' [TTIME] 
+  1X.F15.7.1X, ' [RS] 
+  1X,F15.7,1X. ' [THADV] 
+  1X,F15.7,1X,'[TDPLUG] 


Motor  Torque  Constant',/, 
Motor  Back  EMF  Constant',/, 
Current  Limiting  Resistance  (inside)' 
Current  Limiting  Resistance  (outside) 
Series  R  Added  to  Freewheeling  Diodes 
Motor  Phase  Resistance(Ohm) ' , / , 
Motor  Phase  Inductance (Henries) ',/ , 
Motor  Viscous  Friction  Coeff',/, 
Load  Viscous  Friction  Coeff',/, 
Motor  Inertia(oz-in/s"2) ' , / , 
Load  Inertia(oz-in/s~2) ' , / , 
Equiv  Ckt  Resistance  of  Trans  Satur' , 
Equiv  Ckt  Resistance  of  Trans  Cutoff 
Transistor  Switching  Time',/, 
Internal  Resist  of  Supply  Voltage',/, 
Commutation  Advance  (Electrical  Deg) ' 


,/, 


Commutation  Dead  Time  while  Plugging' 
+  10X,*[Q]       QUIT  THIS  MENU',//, 
+  IX, 'Enter  Variable  Name (UPPERCASE)  or  Q  to  QUIT  — >  '  ,\) 


/, 
,/, 


,/. 
,/, 


return 
end 


***  GRAPHIC  OUTPUT  SELECTION  MENU  *** 
************************************* 


Provides  user  selection  for  graphic  output  of  data. 


subroutine  DISPLA(XORG , YORG , DISOPT , PRTCHR , ELEMNT , DRIVE , XTIME ) 
implicit  real**  (A-Z) 

c ommon  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PLEN 1 , 
+         XTITLE,YTITLE,PTITLE,PTIT1 
real**.  XTIME(IOIO)  ,Y1(1010)  ,Y2(1010) 
integer *2  NPTS , PCTR , XLEN , YLEN , IOPORT , MODEL , ELEMNT 
character*3  DISOPT,PLOPT,DRIVE 
character*25  XTITLE.YTITLE 
character*51  PRTCHR, PT I TLE.PTIT1 

***  Clear  Screen  &  Home  Cursor  *** 
A 10  call  CLRSCR 

if  ((DISOPT  .eq.  'p')  .or.  (DISOPT  .eq.  'P'))  then 
call  GOTOXY(24,20) 
write (*,*)  PRTCHR 
call  GOTOXY(l.l) 
endif 

write(*,1300) 
read(*,*(A)')  PLOPT 


if  ((PLOPT  .eq.  'Q')  .or.  (PLOPT  .eq.  'q'))  then 
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go  to  400 
elseif  (PLOPT  .eq.  ' 1')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE«='FIN  POSITION  (deg)' 
YLEN-19 
if  (ELEMNT  .eq.  1)  then 

PTITLE-'FIN  POSITION  RESPONSE  WITH  RELAY  CONTROLLER' 
PLEN-44 . 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE='FIN  POSITION  RESPONSE  WITH  PWM  CONTROLLER' 
PLEN-42. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR* 
PLEN1-20. 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A' )  then 

open(4,file«'a:BLDCMl.VIR' , status='OLD' , access-' SEQUENTIAL* ) 
elseif  (DRIVE  .eq.  'B' )  then 

open(4,file-'b:BLDCMl,VIR' ,status='OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(4,file-*c:BLDCMl.VIR' , status-'OLD' , access-' SEQUENTIAL' ) 
endif 

do  830  PCTR-l.NPTS 

read (4, 930)  THETAF, ORDER 
930  format(15x,2F15.7) 

YKPCTR) -THETAF 
Y2(PCTR) -ORDER 
830       continue 

close (4, status- 'KEEP' ) 
C 

call  MGRAPH(XTIME,Yl,Y2,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '2')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'FIN  VELOCITY  (dag/sec)* 
YLEN-23 
if  (ELEMNT  .eq.  1)  then 

PTITLE-'FIN  VELOCITY  RESPONSE  WITH  RELAY  CONTROLLER' 
PLEN-44 . 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-'FIN  VELOCITY  RESPONSE  WITH  PWM  CONTROLLER' 
PLEN-42. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR* 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A')  then 
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open(4,file='a:BLDCMl.VIR' , status-'OLD' , access" 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B' )  then 

open(4,file='b:BLDCMl.VIR* ,status='OLD' , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(4,file='c:BLDCMl.VIR' , status-'OLD' , access=' SEQUENTIAL' ) 
end  if 

do  832  PCTR-l.NPTS 

read (4, 932)  OMEGAF 
Yl(PCTR)«OMEGAF 

832  continue 

932  format(45X,F15.7) 
close (A, status-' KEEP ' ) 

C 

call  GRAPH(XTIME,Y1,X0RG,Y0RG,DIS0PT) 
C 

elseif  (PLOPT  .eq.  '3')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'IM  (amps)' 
YLEN-10 
if  (ELEMNT  .eq.  1)  then 

PTITLE- 'MOTOR  SOURCE  CURRENT  WITH  RELAY  CONTROLLER' 
PLEN-43. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE- 'MOTOR  SOURCE  CURRENT  WITH  PWM  CONTROLLER* 
PLEN-41. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  *A' )  then 

open(5,file«'a:BLDCM2.VIR' , status-'OLD* .access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  *B')  then 

open(5,file-'b:BLDCM2.VIR' , status-'OLD* , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(5,file-'c:BLDCM2.VIR* , status-'OLD' , access- 'SEQUENTIAL' ) 
endif 

do  833  PCTR-l.NPTS 
read (5, 933)  IM 
Y1(PCTR)-IM 

833  continue 

933  format(F15.7) 
close ( 5, status- 'KEEP' ) 

C 

call  GRAPH(XTIME,Yl,XORG(YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '«')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 
YTITLE-'IMA  (amps)' 
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YLEN-11 
if  (ELEMNT  .eq.  1)  then 

PTITLE=' MOTOR  PHASE  A  CURRENT  WITH  RELAY  CONTROLLER' 
PLEN-44 . 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE='MOTOR  PHASE  A  CURRENT  WITH  PWM  CONTROLLER' 
PLEN-42 . 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A'  )  then 

open(5,file='a:BLDCM2.VIR' , status='OLD' .access-'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  *B' )  then 

open(5,file='b:BLDCM2.VIR' , status-'OLD' .access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(5,file-'c:BLDCM2.VIR' , status- 'OLD' , access- 'SEQUENTIAL' ) 
endif 

do  83 A  PCTR-l.NPTS 
read( 5,934)  IMA 
Y1(PCTR)=IMA 
834       continue 
934       format(15X,F15.7) 

close(5,status-'KEEP' ) 
C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '5')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'IMB  (amps)' 
YLEN-11. 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' MOTOR  PHASE  B  CURRENT  WITH  RELAY  CONTROLLER' 
PLEN-44. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' MOTOR  PHASE  B  CURRENT  WITH  PWM  CONTROLLER' 
PLEN-42 . 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20. 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  *A' )  then 

open(5,file-*a:BLDCM2.VIR' .status-'OLD' , access-'SEQUENTIAL* ) 
elseif  (DRIVE  .eq.  'B')  then 

open(5,file-'b:BLDCM2.VIR' , status-'OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(5,file-'c:BLDCM2.VIR' , status-'OLD' , access-'SEQUENTIAL' ) 
endif 
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do   835  PCTR-l.NPTS 
read(5,935)    1MB 
Y1(PCTR)-IMB 

835  continue 

935  format(30X,F15.7) 
close(5,status='KEEP' ) 

C 

call  GRAPH(XTIME,Yl,XORG,yORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '6')  then 
XTITLE-'TIME  (seconds)* 
XLEN— 15 

YTITLE-'IMC  (amps)' 
YLEN-11 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' MOTOR  PHASE  C  CURRENT  WITH  RELAY  CONTROLLER* 
PLEN-44. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' MOTOR  PHASE  C  CURRENT  WITH  PWM  CONTROLLER' 
PLEN-42. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A')  then 

open(5,file-'a:BLDCM2.VIR* , status-'OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B' )  then 

open(5,file»'b:BLDCM2.VIR* , status-'OLD' , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(5,file-'c:BLDCM2.VIR* , status-'OLD' , access- 'SEQUENTIAL' ) 
endif 

do  836  PCTR-l.NPTS 
read(5.936)  IMC 
Y1(PCTR)-IMC 

836  continue 

936  format(45X,F15.7) 
close(5,status-'KEEP' ) 

C 

call  GRAPH (XTIME , Yl , XORG , YORG , DISOPT ) 
C 

elseif  (PLOPT  .eq.  '7')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'TM  (oz-in)' 
YLEN-11 
if  (ELEMNT  .eq.  1)  then 

PTITLE-'MOTOR  TORQUE  (oz-in)  WITH  RELAY  CONTROLLER' 
PLEN-A3. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-'MOTOR  TORQUE  (oz-in)  WITH  PWM  CONTROLLER' 
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PLEN-41. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20. 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A' )  then 

open(5,file='a:BLDCM2.VIR' , status='OLD' , access=' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B* )  then 

open(5,file='b:BLDCM2.VIR' , status" 'OLD' , access-'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C )  then 

open(5,file«'c:BLDCM2.VIR' , status- 'OLD' , access-'SEQUENTIAL' ) 
endif 

do  837  PCTR=1,NPTS 
read(5,937)  TM 
Y1(PCTR)=TM 

837  continue 

937  format(60X,F15,7) 
closet  5, status- 'KEEP' ) 

C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  *8')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'TMF  (oz-in)' 
YLEN-12 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' FILTERED  MOTOR  TORQUE  (oz-in)  WITH  RELAY  CONTROLLER' 
PLEN-51. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' FILTERED  MOTOR  TORQUE  (oz-in)  WITH  PWM  CONTROLLER' 
PLEN-50 . 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A')  then 

open(5,file-'a:BLDCM2.VIR' , status-'OLD' .access-'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(5,file-'b:BLDCM2.VIR' , status-'OLD' , access-'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(5,file-'c:BLDCM2.VIR' , status-'OLD' .access-'SEQUENTIAL' ) 
endif 

do  838  PCTR-l.NPTS 
read(5,938)  TMF 
Y1(PCTR)-TMF 

838  continue 

938  format(75X,F15.7) 
close(5,status-'KEEP' ) 
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call  GRAPH(XTIME,Y1,X0RG,Y0RG,DIS0PT) 


elseif  (PLOPT  .eq.  '9')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'VDID  (volts)* 
YLEN-13 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' POWER  TRANSISTOR  #1  VOLTAGE  DROP  (RELAY)' 
PLEN-41. 
elseif  (ELEMNT  .eq.  3)  then 

PT1TLE-' POWER  TRANSISTOR  #1  VOLTAGE  DROP  (PWM)* 
PLEN-39. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR* 
PLEN1-20. 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A')  then 

open(6,file-'a:BLDCM3.VIR' , status-*OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6,file-'b:BLDCM3.VIR' , status-'OLD' , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(6,file-'c:BLDCM3.VIR' , status-'OLD' , access- 'SEQUENTIAL' ) 
endif 

do  839  PCTR-l.NPTS 
read(6,939)  VD1D 
Y1(PCTR)-VD1D 
839       continue 
939       format(F15.7) 

close(6,status-'KEEP' ) 
C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '10')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'VD2D  (volts)' 
YLEN-13 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' POWER  TRANSISTOR  #2  VOLTAGE  DROP  (RELAY)' 
PLEN-41. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' POWER  TRANSISTOR  #2  VOLTAGE  DROP  (PWM)' 
PLEN-39. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR* 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 
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if  (DRIVE  .eq.  'A')  then 

open(6,file='a:BLDCM3.VIR' , status-'OLD* , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6,file='b:BLDCM3.VIR' , status='OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C )  then 

open(6,file='c:BLDCM3.VIR' , status='OLD' , access='SEQUENTIAL* ) 
endif 

do  840  PCTR=1,NPTS 
read(6,940)  VD2D 
Y1(PCTR)=VD2D 

840  continue 

940  format(15X,F15.7) 
close(6, status='KEEP' ) 

C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  *  11')  then 
XTITLE='TIME  (seconds)' 
XLEN— 15 

YTITLE-'VD3D  (volts)* 
YLEN-13 
if  (ELEMNT  .eq.  1)  then 

PTITLE- ' POWER  TRANSISTOR  #3  VOLTAGE  DROP  (RELAY)* 
PLEN-41. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' POWER  TRANSISTOR  #3  VOLTAGE  DROP  (PWM)' 
PLEN-39. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20. 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A' )  then 

open(6,file='a:BLDCM3.VIR' , status-'OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6,file-'b:BLDCM3.VIR' , status-'OLD' , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C )  then 

open(6,file-'c:BLDCM3.VIR' .status-'OLD* , access-'SEQUENTIAL* ) 
endif 

do  841  PCTR-l.NPTS 
read(6,941)  VD3D 
Y1(PCTR)-VD3D 

841  continue 

941  fonnat(30X,F15.7) 
closec 6, status- 'KEEP' ) 

C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '12')  then 
XTITLE-'TIME  (seconds)* 
XLEN— 15 
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YTITLE-'VD4D  (volts)' 
YLEN-13 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' POWER  TRANSISTOR  #4  VOLTAGE  DROP  (RELAY)' 
PLEN-41. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' POWER  TRANSISTOR  #4  VOLTAGE  DROP  (PWM)' 
PLEN-39. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A')  then 

open(6,file=*a:BLDCM3,VIR' , status-'OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6,file-'b:BLDCM3.VIR' , status-'OLD' , access-' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(6,file='c:BLDCM3.VIR' , status-'OLD' , access-'SEQUENTIAL' ) 
endif 

do  842  PCTR-l.NPTS 
read(6,942)  VD4D 
Y1(PCTR)«VD4D 
842       continue 
942       format(45X,F15.7) 

close(6,status-'KEEP' ) 
C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '13')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'VD5D  (volts)' 
YLEN-13 
if  (ELEMNT  .eq.  1)  then 

PTITLE-* POWER  TRANSISTOR  #5  VOLTAGE  DROP  (RELAY)' 
PLEN-41. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-* POWER  TRANSISTOR  #5  VOLTAGE  DROP  (PWM)' 
PLEN-39. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20 . 
C 
C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A')  then 

open(6,file-'a:BLDCM3.VIR' , status-'OLD' , access-'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6,file-'b:BLDCM3.VIR' , status-'OLD* , access-'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(6,file-*c:BLDCM3.VIR, , status-'OLD' .access-'SEQUENTIAL' ) 
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endif 

do  843  PCTR=1,NPTS 
read(6,9A3)  VD5D 
Y1(PCTR)=VD5D 

843  continue 

943       fonnat(60X,F15.7) 

close (6, status- 'KEEP' ) 
C 

call  GRAPH(XTIME,Y1,X0RG,Y0RG,DIS0PT) 
C 

elseif  (PLOPT  ,eq.  '14')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'VD6D  (volts)' 
YLEN-13 
if  (ELEMNT  .eq.  1)  then 

PTITLE-' POWER  TRANSISTOR  #6  VOLTAGE  DROP  (RELAY)' 
PLEN-41. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' POWER  TRANSISTOR  #6  VOLTAGE  DROP  (PWM)' 
PLEN-39. 
endif 

PTITl-'BRUSHLESS  DC  MOTOR' 
PLEN1-20. 
C 
C   ...  Data  Retrieval  . .  . 

if  (DRIVE  .eq.  'A')  then 

open(6,file-'a:BLDCM3.VIR' , status-'OLD' , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(6,file-*b:BLDCM3.VIR' , status-'OLD' , access- 'SEQUENTIAL' ) 
elseif  (DRIVE  ,eq.  'C )  then 

open(6,file-'c:BLDCM3.VIR' , status-'OLD' , access- 'SEQUENTIAL' ) 
endif 

do  844  PCTR-l.NPTS 
read(6,944)  VD6D 
Y1(PCTR)-VD6D 

844  continue 

94  4       format(75X,F15.7) 

close(6, status-'KEEP' ) 
C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 

elseif  (PLOPT  .eq.  '15')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'NODE  0  VOLTAGE  (VDC)* 
YLEN-21 

PTITLE-' CENTER  CONNECTION  VOLTAGE  RESPONSE' 
PLEN-35 . 

PTITl-'BRUSHLESS  DC  MOTOR* 
PLEN1-20 . 
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c 

C   ...  Data  Retrieval  . . . 

if  (DRIVE  .eq.  'A*)  then 

open(4,file='a:BLDCMl.VIR' , status='OLD' , access=' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'B')  then 

open(4,file«=*b:BLDCMl.VIR' , status='OLD' , access=' SEQUENTIAL' ) 
elseif  (DRIVE  .eq.  'C')  then 

open(4,file='c:BLDCMl.VIR' , status-'OLD' , access=*SEQUENTIAL' ) 
endif 

do  845  PCTR-l.NPTS 
read (4, 94 5)  NODE 
Yl(PCTR)=NODE 
845       continue 
945       format(60X,F15.7) 

close(4,status-'KEEP' ) 
C 

call  GRAPH(XTIME,Yl,XORG,YORG,DISOPT) 
C 
C 

else 

go  to  410 
endif 
C 

400  continue 
C 
1300  FORMAT (//, 2X ,' The  following  are  plotting  options',//, 
+  5X,'  [1]  FIN  POSITION  (THETAF)',/, 

+  5X,'  [2]  FIN  VELOCITY  (OMEGAF)',/, 

+  5X,*  [3]  MOTOR  CURRENT  (IM)*,/, 

+  5X,*  [4]  MOTOR  PHASE  A  CURRENT  (IMA)',/, 

+  5X,*  [5]  MOTOR  PHASE  B  CURRENT  (IMB)*,/, 

+  5X,*  [6]  MOTOR  PHASE  C  CURRENT  (IMC)*,/, 

+  5X,'  [7]  MOTOR  TORQUE  (TM)',/, 

+  5X,'  [8]  FILTERED  MOTOR  TORQUE  (TMF)',/, 

+  5X,'  [9]  POWER  TRANSISTOR  #1  VOLTAGE  DROP  (VD1D)' 

+  5X,'[10]  POWER  TRANSISTOR  #2  VOLTAGE  DROP  (VD2D)* 

+  5X,'[11]  POWER  TRANSISTOR  #3  VOLTAGE  DROP  (VD3D)' 

+  5X,'[12]  POWER  TRANSISTOR  #4  VOLTAGE  DROP  (VD4D)' 

+  5X,'[13]  POWER  TRANSISTOR  #5  VOLTAGE  DROP  (VD5D)' 

+  5X,'[14]  POWER  TRANSISTOR  #6  VOLTAGE  DROP  (VD6D)' 

+  5X,'[15]  REFERENCE  NODE  VOLTAGE  RESPONSE  (NODE)*,/ 

+  5X,'[Q]  QUIT  THIS  MENU',//, 

+  2X, 'Enter  selection  [1-15, Q]  — >  ',\) 

C 

return 
end 

C 

c     ******************************************** 

C     *****  Output  Simulation  Specs  to  Printer  *** 
C     ******************************************** 
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C     Dumps  simulation  specifications  to  printer. 

C 

C 

subroutine  PRNOUT (BEGTIM, FINTIM, PTSPLT, MAXITS, SIM2PL, DELTIM, 
+  NTERMS , EO , EDOTO , TYPE , STPMAG, RSLOPE , SINAMP , SINFRQ , 

+  SINPHA, NLCHAR, DBAND, PERIOD. KPWM.RIN, ROUT, RDAD J, 

+  KTM.KBM.KV.KP.RA.LA.BM.BL.JM.JL.RSAT.RCUT.TTIME, 

+  RS.THADV.TDPLUG) 

implicit  REAL*4  (A-Z) 
integer*2  SIM2PL, NTERMS 
character*6  TYPE 
character*25  NLCBAR 
C 

C   ...  Printer  ready??  . . . 
call  CLRSCR 
call  GOTOXY(12,25) 

write(*,*)  'Please  ensure  PRINTER  is  ready' 
call  GOTOXY(20,1) 
PAUSE 
C   ...  Output  Simulation  Options  to  Printer  , . . 

open(8, file='prn' , status«'new* ) 
C 

wr ite ( 8 , 1600 )  BEGTIM , FINTIM, PTSPLT , MAXITS , SIM2PL , DELTIM, 
+  NTERMS, EO, EDOTO 

wr ite ( 8 , 1601 )  TYPE , STPMAG , RSLOPE , SINAMP , SINFRQ , SINPHA, 
+  NLCBAR, DBAND, PERIOD, KPWM.RIN, ROUT, RDAD J 

write<8,1602)  KTM,KBM,KV,KP,RA,LA,BM,BL, JM, JL.RSAT, 
+  RCUT,TTIME,RS,THADV,TDPLUG 

write(8,1603) 
C 

1600  format(/,18X,'***  BRUSHLESS  DC  MOTOR  SIMULATION  SPECS  ***',/, 
+  1X,F15.7,1X,' [BEGTIM]   Start  Time  of  Plotting  Window',/, 

+  1X.F15.7, IX, '[FINTIM]   Stop  Time  of  Plotting  Window*,/, 
+  1X,F15.7,1X, ' [PTSPLT]   Points  to  be  Plotted  per  Curve*,/, 
+  IX, F15. 7.1X, ' [MAXITS]   Max  Number  of  Simulation  Iterations*,/, 
+  13X,I3,1X,   ' [SIM2PL]   Ratio:  Points  Simulated/Plotted',/, 
+  1X.F15.7, IX, ' [DELTIM]   Simulation  Step  Size  (seconds)',/, 
+  10X,I6,1X,   '[NTERMS]   Total  Number  of  Simulation  Steps*,/, 
+  1X,F15.7,1X, '[E0]      Initial  Fin  Position  ERROR  (deg)',/, 
+  1X.F15.7, IX, ' [EDOTO]    Initial  Fin  Velocity  ERROR  (deg/s)',//) 

1601  format(25X,'***  COMMAND  INPUT  SELECTION  ****./, 

+  1X.A15.1X,   '[TYPE]     STEP,  RAMP,  or  SINE  Response*,/, 

+  1X.F15.7, IX, ' [STPMAG]   Commanded  Position  for  STEP  Response',/, 

+  1X.F15.7, IX,' [RSLOPE]   Slope  of  RAMP  Function',/, 

+  1X,F15.7,1X, ' [SINAMP]   Amplitude  of  SINE  Function',/, 

+  1X.F15.7.1X, ' [SINFRQ]   Frequency  (deg/sec)  of  SINE  Function',/, 

+  1X,F15.7,1X,' [SINPHA]   Phase  Angle  (deg)  of  SINE  Function',//, 

+  27X,'***  CONTROLLER  SELECTION  ****,/, 

+  1 OX, 'CONTROLLER  SELECTION  -->  \A30,/, 

+  1X,F15.7,1X, ' [DBAND]    Deadband  Applied  to  System  Feedback*,/, 

+  1X,F15.7,1X, ' [PERIOD]   Period  of  PWM  Reference  Cycle(sec)' ,/, 
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c 


+  1X,F15.7,1X, ' [KPWM]  PWM  Amplifier  Gain',/, 

+  1X,F15.7,1X, ' [RIN]  Current  Limiting  Resistance  (inside)',/, 

+  1X.F15.7.1X, ' [ROUT]  Current  Limiting  Resistance  (outside)',/, 

+  1X,F15.7,1X, ' [RDADJ]  Series  R  Added  to  Freewheeling  Diodes*,//) 

1602  format(25X, ****  MOTOR  PARAMETER  SELECTION  ***',/, 
+  1X,F15.7,1X, * [KTM]  Motor  Torque  Constant',/, 

+  1X,F15.7,1X, ' [KBM]  Motor  Back  EMF  Constant',/, 

+  1X,F15.7,1X, ' [KV]  Motor  Velocity  Feedback  Constant',/, 

+  1X,F15.7,1X, ' [KP]  Motor  Position  Feedback  Constant',/, 

+  1X,F15.7,1X, ' [RA]  Motor  Phase  Resistance (Ohm) ',/ , 

+  1X.F15.7.1X, ' [LA]  Motor  Phase  Inductance (Henries) ',/ , 

+  1X,F15,7,1X, ' [BM]  Motor  Viscous  Friction  Coeff',/, 

+  1X,F15.7,1X,'[BL]  Load  Viscous  Friction  Coeff',/, 

+  1X.F15.7.1X,' [JM]  Motor  Inertia(oz-in/s~2) ' , / , 

+  1X.F15.7.1X, ' [JL]  Load  Inertia(oz-in/s~2) ' , / , 

+  1X.F15.7.1X, ' [RSAT]  Equiv  Ckt  Resistance  of  Trans  Satur',/, 

+  1X.F15.7.1X, * [RCUT]  Equiv  Ckt  Resistance  of  Trans  Cutoff',/, 

+  1X,F15.7,1X, ' [TTIME]  Transistor  Switching  Time*,/, 

+  1X,F15.7,1X, ' [RS]  Internal  Resist  of  Supply  Voltage',/, 

+  1X,F15.7,1X, ' [THADV]  Commutation  Advance  (Electrical  Deg)',/, 

+  1X,F15.7,1X, ' [TDPLUG]   Commutation  Dead  Time  while  Plugging*,/) 

1603  formate  1') 
close(8,status-'KEEP' ) 

return 
end 


C  BLDCM3A.FOR     (subroutines  GRAPH , MGRAPH , PWMOD , RELAY , 

C  COMADV, HALL , TRANSW, LIMIT , FCNSW, STEP , DEADSP , 

C  RAMP,TC0NST,DERIV,INTGRL,CLRSCR,GOT0XY) 

C  These  subroutines  must  be  compiled  as  a  group  separately  from 

C  BLDCM1  because  of  compiler  size  limitations.  BLDCM3A  must  be 

C  linked  to  BLDCM1  &  BLDCM2A  at  link  time. 

C 

C  Last  Revision  -->  04  April  1987 

C  LT  Vincent  S.  Rossitto,  USN 

C 

Q        ******************************** 

C   *****  PLOTTING  SUBROUTINES  ***** 
C  *****(single  function  plot)***** 

Q        ******************************** 

Subroutine  GRAPH (X.Y.XORG, YORG.DISOPT) 
C 

implicit  REAL*4  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PLEN1 , 
+       XTITLE,YTITLE,PTITLE,PTIT1 
real*4  X(1010) ,Y(1010) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , NCHAR , NCHAR1 
character*3  DISOPT.ANS 
character*25  XTITLE, YTITLE 


221 


character*51  PTITLE.PTIT1 
C 

C  ...  Make  a  new  title. . . 
5  call  CLRSCR 

if  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.  'p'))  then 
call  GOTOXY(8,30) 
write (*,*)  'Current  Title  is:' 
call  GOTOXYU0.20) 
write(*,*)  PTITLE 
call  GOTOXY(11,20) 
write(*,*)  PTIT1 
call  GOT0XY(15,25) 

write (*,' (A\ )' )  'Do  you  want  to  change  the  title?  ' 
read(*. '(A)')  ANS 
call  CLRSCR 
if  ((ANS  .eq.  'Y' )  .or.  (ANS  .eq.  'y'))  then 
call  GOT0XY(5,10) 
wri,te(*,*)  'Enter  titles  in  left  justified  format' 

call  GOTOXY(12,10) 
write(*,*)  '12345678901234567890123456789012345678901234567890' 

call  GOTOXY(13,10) 
write(*,*)  *         1         2         3         4         5' 

call  GOTOXY(15,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXY(20,10) 
write (*.*)  '1234  5678901234567890123456789012345678901234567890' 

call  GOTOXY(21,10) 
write(*,*)  '         1         2         3         A         5' 

call  GOTOXY(23,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXY(ll,U) 
read(*,*(A51)')  PTITLE 

call  GOTOXY(15,46) 
read(*,*)  PLEN 

call  GOTOXY(19,ll) 
read(*,*(A51)*)  PTIT1 
call  GOTOXY(23,46) 
read(*,*)  PLEN1 
elseif  ((ANS  .eq.  'N')  .or.  (ANS  .eq.  'n'))  then 

go  to  10 
endif 
go  to  S 
endif 
C 

10  call  GOTOXY(10,25) 

write(*,*)  'Calculating  Plotting  Data' 
C 

AS PRAT-. 65 

CHARHT- . 22 

PTX- . 5+ ( 6 . - PLEN*ASPRAT*CHARHT ) / 2 . 

PTY-4 . 5 
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PTX1- . 5+ ( 6 . -PLEN1*ASPRAT*CHARHT ) /2 . 

PTY1-4 . 1 

NCHAR-ifix(PLEN) 

NCHARl=ifix(PLENl) 
C 

call  PLOTS (O.IOPORT, MODEL) 

call  FACTOR(l.OO) 

call  ASPECT (ASPRAT) 
C  . . .  Draw  a  Border  . . . 

if  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.  'p*))  then 
call  PLOT(XORG,YORG,-13) 
call  PLOT(8.0,0.0,2) 
call  PLOT(8.0,6.0,2) 
call  PLOT(0.0,6.0,2) 
call  PLOT(0.0,0.0,2) 

end  if 
C 
C     call  SCALE(X,6.,NPTS,1) 

call  SCALE(Y,4. ,NPTS,1) 

call  STAXIS(.15, .22, .12, .080,3) 
C   ...  This  scaling  applies  when  the  X  axis  represents  Time. 

XCNPTS+D-BEGTIM 

FIRSTX  =  XCNPTS+1) 

X(NPTS+2)-(X(NPTS)-X(NPTS+l))/6. 

DELTAX  -  X(NPTS+2) 

FIRSTY  -  YCNPTS+1) 

DELTAY  -  Y(NPTS+2) 

call  PLOTd.25,1.,-13) 

call  AXIS(0.0,0.0,XTITLE,XLEN,6.,0. , FIRSTX, DELTAX) 

call  STAXIS(.15,.22,.12,.080,2) 

call  AXIS(0. ,0.,YTITLE,YLEN, 4., 90., FIRSTY, DELTAY) 

call  SYMBOL (PTX,PTY,CHARHT,PTITLE, 0 . ,NCHAR) 

call  SYMBOL (PTX1,PTY1,CHARHT,PTIT1, 0 . ,NCHAR1) 

call  LINE(X,Y,NPTS, 1,0,0) 

call  PLOT(0.,0. ,999) 
C 

MODEL-99 

IOPORT-99 
C 

return 

end 
C 
c   ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
C  *****  (multi-function  plot)***** 
C   ******************************** 


Subroutine  MGRAPHCX.Y, Z,XORG,YORG, DISOPT) 

implicit  REAL*4  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PLEN 1 , 
+       XTITLE,YTITLE,PTITLE,PTIT1 
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real*A  X(1010) , Y( 1010) , Z(1010) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , NCHAR , NCHAR1 
character*3  DISOPT, ANS 
character*25  XTITLE, YTITLE 
character*51  PTITLE, PTIT1 
C 

ASPRAT-.65 
CHARHT= . 22 
CHARH1-.20 
C 

C  ...  Make  a  new  title. . . 
5   call  CLRSCR 

if  ((DISOPT  .eq.  'P*)  .or.  (DISOPT  .eq.  'p'))  then 
call  GOTOXY(8,30) 
write(*,*)  'Current  Title  is:' 
call  GOTOXY(10,20) 
write(*,*)  PTITLE 
call  GOTOXY(11,20) 
write(*,*)  PTIT1 
call  GOTOXY(15,25) 

write(*, ' (A\ ) ' )  'Do  you  want  to  change  the  title?  ' 
read(*, '(A)')  ANS 
call  CLRSCR 
if  ((ANS  .eq.  'Y')  .or.  (ANS  .eq.  'y'))  then 
call  GOTOXY(5,10) 
write!*,*)  'Enter  titles  in  left  justified  format' 

call  GOTOXY(12,10) 
write(*,*)  '12345678901234567890123456789012345678901234567890' 

call  GOTOXY(13,10) 
write(*,*)  '         1         2         3         A         5' 

call  GOTOXY(15,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXY(20,10) 
write(*,*)  '12345678901234567890123455789012345678901234567890' 

call  GOTOXY(21,10) 
write(*,*)  '         12        3         4         5' 

call  GOTOXY(23,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXY(ll,ll) 
read(*,'(A51)' )  PTITLE 

call  GOTOXY(15,46) 
read(*,*)  PLEN 

call  GOTOXY(19,ll) 
read(*,'(A51)*)  PTIT1 
call  GOTOXY(23,46) 
read(*,*)  PLEN1 
elseif  ((ANS  .eq.  'N* )  .or.  (ANS  .eq.  'n'))  then 

go  to  10 
end  if 
go  to  5 
endif 
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10  call  GOTOXY(10,25) 

write (*,*)  'Calculating  Plotting  Data' 
C 

PTX= . 5+ ( 6 . -PLEN*ASPRAT*CHARHT )  /2 . 

PTY=4 . 5 

PTX1= . 5+ ( 6 . -PLEN1*ASPRAT*CHARH1 ) /2 . 

PTY1-4 . 1 

NCHAR=ifix(PLEN) 

NCHARl-ifix(PLENl) 
C 

call  PLOTS (0.IOPORT, MODEL) 

call  FACTOR(l.OO) 

call  ASPECT (ASPRAT) 
C  ...  Draw  a  Border  . . . 

if  ((DISOPT  ,eq.  'P')  .or.  (DISOPT  .eq.  *p*))  then 
call  PLOT(XORG,YORG,-13) 
call  PLOT(8.0,0.0,2) 
call  PLOT(8.0,6.0,2) 
call  PLOT(0.0,6.0,2) 
call  PLOT(0.0,0.0,2) 

end  if 
C 
C 
C   ...  This  scaling  applies  when  the  X  axis  represents  Time. 

X(NPTS+1)«BEGTIM 

FIRSTX  -  X(NPTS+1) 

X(NPTS+2)-(X(NPTS)-X(NPTS+l))/6. 

DELTAX  -  X(NPTS+2) 
C 

call  SCALE ( Y, k. ,NPTS,1) 

call  SCALE(Z,4. ,NPTS,1) 

if  (ZCNPTS+2)  .gt.  YCNPTS+2))  then 
Y(NPTS+2)«Z(NPTS+2) 

else 

Z(NPTS+2)-Y(NPTS+2) 

endif 

FIRSTY-YCNPTS+1) 

DELTAY  -  YCNPTS+2) 
C 

call  PLOTd.25,1.  ,-13) 

call  STAXIS(.15, .22, .12, .080,3) 

call  AXIS(0.0,0.0,XTITLE,XLEN,6. , 0 ., FIRSTX , DELTAX ) 

call  STAXIS(.15, .22, .12,. 080, 2) 

call  AXIS(0.0,0.0,YTITLE,YLEN,4.,90. .FIRSTY, DELTAY) 

call  SYMBOL ( PTX, PTY, CHARHT, PTITLE, 0. ,NCHAR) 

call  SYMBOL(PTX1,PTY1,CHARH1,PTIT1,0. ,NCHAR1) 

call  LINE(X,Y,NPTS, 1,0,0) 

call  CURVE(X,Z,NPTS,-.l) 

call  PLOT(0.,0. ,999) 


225 


MODEL-99 

IOPORT-99 
C 

return 

end 
C 
c    **************************************** 

c    *****  pulse  WIDTH  MODULATOR  MODULE  ***** 


c    **************************************** 

c 

Subroutine  PWMOD (TIME , NUMIT , TSTART , PERIOD , TOGGLE , POSERR , 
+    DBAND,VIF,VIB,DIR,VREF, THRESH, KPWM) 
C 

IMPLICIT  REAL*4  (A-Z) 
INTEGER*2  NUMIT, DIR 
LOGICAL*2  WAITNG, TOGGLE 
C 

C  . . .  Reset  the  saw-tooth  reference  signal  ... 
if  (TIME  .ge,  TSTART+PERIOD)  then 
TSTART-TSTART+PERIOD 
TOGGLE-. true, 
endif 
C 

if  (POSERR  .gt.  (O.+DBAND))  then 
DIR-1 

ERROR-abs (KPWM* ( POSERR-DBAND ) ) 
elseif  (POSERR  .It.  (O.-DBAND))  then 
DIR— 1 

ERROR-abs (KPWM* ( POSERR+DBAND ) ) 
else 

ERROR-0 . 
endif 

call  LIMIT (0..1. .ERROR, ERROR) 
call  RAMP (TIME, TSTART, NREF) 
VREF-NREF/ PERIOD 
THRESH-1 . -ERROR 
C 

C   ...  "WAITNG"  is  a  logical  variable  indicating  whether  or  not  a  new 
C       pulse  may  be  generated  . . . 

if  (NUMIT  .eq.  1)  WAITNG-TOGGLE 
C 

if  (WAITNG)  then 

if  (VREF  .gt.  THRESH)  then 
if  (DIR  .eq.  1)  then 
VIF-75. 
VIB— 75. 
TOGGLE-. false, 
elseif  (DIR  .eq.  -1)  then 
VIF-75. 
VIB— 75. 
TOGGLE-. false. 
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endif 
elseif  (VREF  .It.  THRESH)  then 
VIF-0 . 
VIB-0 . 

TOGGLE- . true . 
endif 
endif 
C 

return 
end 
C 

Q  ************************ 

c    *****  RELAY  MODULE  ***** 

Q  ************************ 

c 

Subroutine  RELAY (POSERR,DBAND,VIF,VIB,DIR) 
C 

implicit  REAL**  (A-Z) 
integer*2  DIR 
C 

if  (POSERR  .gt.  DBAND)  then 
VIF-75. 
VIB— 75, 
DIR-1 
elseif  (POSERR  .It.  -DBAND)  then 
VIF-75. 
VIB— 75. 
DIR— 1 
elseif  (abs (POSERR)  .le.  DBAND)  then 
VIF-0 . 
VIB-0 . 
endif 
C 

return 
end 
C 
c    ****************************************** 

C    *****  Commutation  Advance  Subroutine  ***** 

Q  ****************************************** 

Subroutine  COMADV ( THETA , PI , THADV , THCON , THRST ) 
implicit  REAL*4  (A-Z) 
THDEG-THETA* ( 180 . 0/PI ) 
THRST-AMOD(THDEG, 360 . 0 ) 
if  (THRST  .LT.  0.0)  THRST-THRST+360. 
THCON-THRST+THADV 


return 

end 
C 
c    ***************************************** 

C    *****  Hall  Sensor  Positioning  Subroutine 
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Subroutine  HALL (THCON >SE1,SE2,SE3) 
implicit  REAL**  (A-Z) 
if  (THCON  .ge.  180  0)  THCON=THCON-180 . 


10 


11 


12 


13 


14 


15 


20 


if  ((THCON 

•  ge 

if  ((THCON 

.ge 

if  ((THCON 

ge 

if  ((THCON 

.ge 

if  ((THCON 

.ge 

if  ((THCON 

.ge 

SE1-1. 

SE2-0 . 

SE3-1. 

go  to  20 

SE1-1. 

SE2=0 . 

SE3-0. 

go  to  20 

SE1-1. 

SE2-1. 

SE3-0. 

go  to  20 

SE1-0. 

SE2-1. 

SE3-0. 

go  to  20 

SE1-0. 

SE2-1 . 

SE3-1. 

go  to  20 

SE1-0. 

SE2-0 . 

SE3-1. 

continue 

return 

end 

0.0)  .and.  (THCON  .It.  30.0))  go  to  10 
30,0)  .and.  (THCON  .It.  60.0))  go  to  11 
60.0)  .and.  (THCON  .It.  90.0))  go  to  12 
90.0)  .and.  (THCON  .It.  120.0))  go  to  13 
120.0)  .and.  (THCON  .It.  150.0))  go  to  14 
150.0)  .and.  (THCON  .It.  180.0))  go  to  15 


*****  General  Commutation  Subroutine  ***** 

Subroutine  TRANSW(TIME,REVTIM,BEMFA,BEMFB,BEMFC.BEMFT, VEMFA, 
+  VEMFB,VEMFC,VIB,VIF,IM,IMA,IMB,IMC,VN1,VN2,SW1, 

+  SW2 , SW3 , SWA , SW5 , SW6 , THCON , THCON1 , RSAT , POSIT , DZR , 

+  VD1D,VD2D,VD3D,VD4D,VD5D,VD6D,RIN,R0UT,RS> 

+  REQA1 ,REQA2 ,REQB1 ,REQB2,RE0C1 .REQC2 , IAB , IBC , 

+  ICA, PVAO , PVBO , PVCO , NODE , TRIG1 , TRIG2 , TRIG3 , 

+  TRIG* , TRIGS , TRIG6 , RA , PLUG , VAIND , VBIND , VCIND ) 

implicit  REAL**  (A-Z) 

integer *2  POSIT , DIR , TRIG1 , TRIG2 , TRIG3 , TRIG* , TRIG5 , TRIG6 , PLUG 


THCON l-amod( THCON, 180 . 0 ) 
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if  (THC0N1  .It.  0.0)  THCONl=THCON 1+180 . 
IM= ( abs ( IMA ) +abs ( 1MB )+abs ( IMC ) ) / 2 . 

if  (TRIG1  .eq.  1)  then 

PVAOX-abs (VAIND)+IMA* (RA+RIN/2. ) 
elseif  (TRIG2  .eq.  1)  then 

PVAOX— abs (VAIND)+IMA* (RA+RIN/2. ) 
else 

PVAOX-VAIND+IMA* (RA+RIN/2. ) 
end  if 

if  (TRIG3  .eq.  1)  then 

PVBOX=abs (VBIND )+IMB* (RA+RIN/2 . ) 
elseif  (TRIGA  .eq.  1)  then 

PVBOX— abs (VBIND )+IMB* (RA+RIN/2 . ) 
else 

FVBOX-VBIND+IMB* (RA+RIN/2. ) 
endif 

if  (TRIG5  .eq.  1)  then 

PVCOX-abs(VCIND)+IMC* (RA+RIN/2. ) 
elseif  (TRIG6  .eq.  1)  then 

PVCOX— abs (VCIND)+IMC* (RA+RIN/2. ) 
else 

PVCOX-VCIND+ IMC* (RA+RIN/2. ) 
endif 

.and.  (PLUG  .eq.  0))  then 

0.0)  .and.  (TBCON1  .It.  30.0))  POSIT=l 
30.0)  .and.  (THCON1  .It.  60.0))  POSIT-2 
60.0)  .and.  (THCON1  .It.  90.0))  POSIT-3 
90.0)  .and.  (THCON1  .It.  120.0))  POSIT-4 
120.0)  .and.  (THCON1  .It.  150.0))  POSIT=5 
150.0)  .and.  (THCON1  .It.  180.0))  POSIT=6 
elseif  ((DIR  .eq.  -1)  .and.  (PLUG  .eq.  0))  then 

if  ((TBCON1  .ge.  0.0)  .and.  (THCON1  .It.  30.0))  POSIT=4 
if  ((THCON1  .ge.  30.0)  .and.  (THCON1  .It.  60.0))  POSIT-5 
60.0)  .and.  (THCON1  .It.  90.0))  POSIT=6 
90.0)  .and.  (THCON1  .It.  120.0))  POSIT=l 
120.0)  .and.  (THCON1  .It.  150.0))  POSIT-2 
150.0)  .and.  (THCON1  .It.  180.0))  POSIT=3 

1)  then 
C 

C    (  NODE  is  the  WYE  center  point  floating  voltage  ) 
NODE— (PVCOX+FVBOX)+float(DIR)*(VEMFC-VEMFB) 
if  (PLUG  .eq.  0)  then 
SW1-0 . 
SW2-0 . 
SW3-0. 
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if  ((DIR  .eq. 

1)  . 

if  ((THCON1 

.ge. 

if  ((THCON1 

.ge. 

if  ((THCON1 

.ge. 

if  ((THCON1 

.ge. 

if  ((THCON1 

.ge. 

if  ((THCON1 

.ge. 

if  ((THCON1 

•  8« 

if  ((THCON1 

.ge 

if  ((THCON1 

.ge 

if  ((THCON1 

.ge 

endif 

if  (POSIT  .e 

q- 

SW4-1. 
SW5-1 . 
SW6=0 . 

IAB-O. 

ICA-0 . 

BEMFT-BEMFC-BEMFB 

VN1-VIF-VEMFC 

VN2-VIB-VEMFB 

VD1D=(VIF-IM* (RS+ROUT) /2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D«( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D«(VIF-IM* (RS+ROUT) /2.)-(PVBOX+VEMFB+NODE) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D— IMB*REQB2 

if  (VD4D  .le.  -.6)  TRIG4  «=  1 

VD5D«IMC*REQC1 

if  (VD5D  .le.  -.6)  TRIGS  -  1 

VD6D-.( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  ,le.  -.6)  TRIG6  -  1 

elseif  (PLUG  .eq.  1)  then 
SW1-0 . 
SW2-0 . 
SW3-0 . 
SW4-1. 
SW5-0. 
SW6-0 . 

IAB-O. 

IBC-0 . 

ICA-0 . 

BEMFT-BEMFC-BEMFB 

VN1-VIF-VEMFC 

VN2-VIB-VEMFB 

VD1D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D- ( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D- (VIF- IM* ( RS+ROUT )/ 2 .)-( PVBOX+VEMFB+NODE ) 
if  (VD3D   le.  -.6)  TRIG3  -  1 
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VD4D- ( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD 5D= ( VIF - IM* ( RS+ROUT )/ 2 .)-( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  =  1 

endif 

elseif  (POSIT  .eq.  2)  then 

NODE— ( PVAOX+PVBOX )+f loat ( DIR ) * ( VEMFB -VEMFA ) 
if  (PLUG  .eq.  0)  then 

SW1-1. 

SW2-0 . 

SW3-0 . 

SW«=1. 

SW5-0 . 

SW6-0 . 

IBC-0 . 
ICA-0 . 

BEMFT-BEMFA-BEMFB 
VN1-VIF -VEMFA 
VN2-VIB -VEMFB 

VD1D«IMA*REQA1 

if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D- ( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD  3D- ( VIF - IM* ( RS+ROUT ) / 2 . ) - ( PVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D-- IMB*REQB2 

if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD5D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIGS  -  1 

VD6D- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 

elseif  (PLUG  .eq.  1)  then 
SW1-0 . 
SW2-0 . 
SW3-0 . 
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SWA=1. 
SW5-0 . 
SW6-0 . 

IAB-O. 

IBC»0 , 

ICA-0 . 

BEMFT-BEMFA-BEMFB 

VN1=VIF-VEMFA 

VN2=VIB-VEMFB 

VD  ID- ( VI F-IM* (RS+ROUT )/2. )-( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D= ( PVAOX+VEMFA+NODE ) - ( VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D= ( VIF - IM* ( RS+ROUT )/ 2 .)-( FVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  =  1 

VD4D- ( FVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD5D-(VIF-IM* (RS+ROUT )/2.)-(PVCOX+VEMFC+NODE) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D=(PVCOX+VEMFC+NODE)- (VIB+IM* (RS+ROUT )/2. ) 
if  (VD6D  .le   -.6)  TRIG6  -  1 

endif 

elseif  (POSIT  .eq.  3)  then 

NODE— ( PVAOX+PVCOX )+f loat (DIR) * ( VEMFA-VEMFC ) 
if  (PLUG  .eq.  0)  then 

SW1-1 . 

SW2-0 . 

SW3-0 . 

SW4-0 . 

SW5-0. 

SW6-1. 

IAB-0. 

IBC-0 . 

BEMFT-BEMFA-BEMFC 

VN1-VIF-VEMFA 

VN2-VIB-VEMFC 

VD1D-IMA*REQA1 

if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D-( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
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if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D=(VIF-IM* (RS+ROUT ) /2 . ) - ( PVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D=(FVBOX+VEMFB+NODE) -(VIB+IM* (RS+ROUT )/2. ) 
if  (VD4D  .le.  -.6)  TRIGA  -  1 

VD5D= ( VIF-IM* (RS+ROUT ) /2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIGS  -  1 

VD6D—IMC*REQC2 

if  (VD6D  .le.  -.6)  TRIG6  =  1 

elseif  (PLUG  .eq.  1)  then 
SW1«=0 . 
SW2-0 . 
SW3-0 . 
SWA-0. 
SW5-0 . 
SW6-1 . 
IAB-0. 
IBOO . 
ICA«0 . 

BEMFT«BEMFA-BEMFC 
VN1-VIF-VEMFA 
VN2-VIB-VEMFC 

VD1D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D- ( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D- ( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VDAD  .le.  -.6)  TRIGA  -  1 

VD5D- ( VIF- IM* (RS+ROUT ) /2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  =  1 

VD6D-( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  «  1 

endif 

elseif  (POSIT  .eq.  4)  then 

NODE— ( PVBOX+PVCOX )+f loat (DIR) * ( VEMFC-VEMFB ) 
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if  (PLUG  .eq.  0)  then 
SW1-0 . 
SW2-0 . 
SW3-1 . 
SW4-0 . 
SW5-0 , 
SW6-1 . 

IAB-0. 
ICA-0 . 

BEMFT=BEMFB -BEMFC 
VN1-VIF-VEMFB 
VN2=VIB-VEMFC 

VD1D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D-( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT )/2.) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D-IMB*REQB1 

if  (VD3D  .le.  -.6)  TRIG3  =  1 

VD4D- ( PVBOX+VEMFB+NODE )- (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD  5D- ( VI F - IM* ( RS+ROUT ) / 2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D— IMC*REQC2 

if  (VD6D  .le.  -.6)  TRIG6  -  1 

elseif  (PLUG  .eq.  1)  then 
SW1-0 . 
SW2-0 . 
SW3-0 . 
SW4-0 . 
SW5-0 . 
SW6-1 . 

IAB-0. 

IBC-0 . 

ICA-0 . 

BEMFT-BEMFB - BEMFC 

VN1-VIF-VEMFB 

VN2-VIB-VEMFC 

VD ID- (VIF- IM* (RS+ROUT )/ 2 .)-( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D- ( PVAOX+VEMFA+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
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if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D=(VIF-IM* (RS+ROUT) /2.)- (PVBOX+VEMFB+NODE) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D- ( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD5D= (VIF- IM* (RS+ROUT ) / 2 . ) - ( FVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIGS  -  1 

VD6D- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 

endif 

elseif  (POSIT  .eq.  5)  then 

NODE— (PVBOX+PVAOX)+float(DIR)*(VEMFB-VEMFA) 
if  (PLUG  .eq.  0)  then 

SW1«=0 . 

SW2=1 . 

SW3-1 . 

SW4-0 . 

SW5-0 . 

SW6-0 . 

IBC-0 . 

ICA-0 . 

BEMFT-BEMFB-BEMFA 

VNl-VIF-VEMFB 

VN2»VIB-VEMFA 

VD ID- ( VIF - IM* ( RS+ROUT )/ 2 .)-( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D— IMA*REQA2 

if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D-IMB*REQB1 

if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D- ( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD4D  .le.  -.6)  TRIG*  -  1 

VD  5D- ( VIF - IM* ( RS+ROUT ) / 2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D- ( FVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 
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eLseif  (PLUG  .eq.  1)  then 
SW1-0 . 
SW2-1 . 
SW3-0 . 
SW4-0 . 
SW5-0 . 
SW6-0 . 

IAB-O. 

IBC-0 . 

ICA=0 . 

BEMFT=BEMFB - BEMFA 

VN1=VIF-VEMFB 

VN2=VIB-VEMFA 

VD1D=(VIF-IM* (RS+ROUT ) /2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D- ( PVAOX+VEMFA+NODE ) - ( VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D- (VIF-IM* (RS+ROUT ) /2 . ) - ( PVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D-( PVBOX+VEMFB+NODE )- (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD 5D- ( VIF - IM* ( RS+ROUT )/ 2 .)-( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) / 2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 

endif 

elseif  (POSIT  .eq.  6)  then 

NODE— ( PVCOX+PVAOX ) +f loat ( D IR ) * ( VEMFA-VEMFC ) 
if  (PLUG  .eq.  0)  then 

SW1-0 . 

SW2-1 . 

SW3-0 . 

SW4-0 . 

SW5-1. 

SW6-0. 

IAB-0. 
IBC-0 . 

BEMFT-BEMFC - BEMF A 
VN1-VIF-VEMFC 
VN2-VIB-VEMFA 
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VD ID- ( VIF - IM* ( RS+ROUT ) / 2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  ■=  1 

VD2D=-IMA*REQA2 

if  (VD2D  .le.  -.6)  TRIG2  -  1 

VD3D- ( VIF- IM* (RS+ROUT ) /2 . ) - ( PVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D= (PVBOX+VEMFB+NODE) -(VIB+IM* (RS+ROUT )/2.) 
if  (VD4D  .le.  -.6)  TRIG4  -  1 

VD5D«IMC*REQC1 

if  (VD5D  .le.  -.6)  TRIG5  -  1 

VD6D= ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 

elseif  (PLUG  .eq.  1)  then 
SW1-0 . 
SW2-1 . 
SW3-0 . 
SW4-0 . 
SW5-0 . 
SW6-0 . 

IAB-0. 

IBC-0. 

ICA-0 . 

BEMFT-BEMFC-BEMFA 

VN1-VIF-VEMFC 

VN2-VIB-VEMFA 

VD1D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVAOX+VEMFA+NODE ) 
if  (VD1D  .le.  -.6)  TRIG1  -  1 

VD2D- ( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD2D  .le.  -.6)  TRIG2  =  1 

VD3D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVBOX+VEMFB+NODE ) 
if  (VD3D  .le.  -.6)  TRIG3  -  1 

VD4D- ( PVBOX+VEMFB+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD4D  .le.  -.6)  TRIG*.  -  1 

VD5D-(VIF-IM* (RS+ROUT ) /2 . ) - ( PVCOX+VEMFC+NODE ) 
if  (VD5D  .le.  -.6)  TRIG5  =  1 

VD6D- ( PVCOX+VEMFC+NODE ) - (VIB+IM* (RS+ROUT ) /2 . ) 
if  (VD6D  .le.  -.6)  TRIG6  -  1 
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end  if 


end  if 
99   continue 
return 
end 
C    ************************************************* 

C    *****  Cutoff-Saturation  Limiting  Subroutine  ***** 

Q  ************************************************* 

Subroutine  LIMIT (RSAT , RCUT , INPUT , OUT ) 
implicit  REAL**  (A-Z) 
if  (INPUT  .le.  RSAT)  then 

OUT=RSAT 
elseif  (INPUT  .ge.  RCUT)  then 

OUT-RCUT 
else 

OUX-INPUT 
end  if 
C 

return 
end 
c    ************************************** 

C    *****  Function  Switch  Subroutine  ***** 
c    ************************************** 


Subroutine  FCNSW(X1 ,X2,X3 ,XA ,OUT) 
implicit  REAL**  (A-Z) 
if  (XI  .It.  0.0)  then 

OUT-X2 
elseif  (XI  , eq  0.0)  then 

OUT-X3 
else 

OUT-X4 
end  if 
C 

return 
end 
c    ************************************ 

C    *****  Step  function  Subroutine  ***** 
c    ************************************ 

Subroutine  STEP ( TIME, TSTEP, OUT) 
implicit  REAL*A  (A-Z) 
if  (TIME  .ge.  TSTEP)  then 

OUT- 1.0 
else 

OUT-0 . 0 
end  if 
C 

return 
end 
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C  *****   Deadspace  Subroutine   ***** 

Q       ******************************** 

Subroutine  DEADSP ( PI , P2 , VSGDEL , VSGERR ) 
implicit  REAL**  (A-Z) 
if  (VSGDEL  .gt.  P2)  then 

VSGERR-VSGDEL-P2 
elseif  (VSGDEL  .It.  PI)  then 

VSGERR-VSGDEL-P1 
else 

VSGERR-0 . 0 
end  if 
C 

return 
end 
c    *************************** 

C    *****  Ramp  Subroutine  ***** 
c    *************************** 


Subroutine  RAMP (TIME, TRAMP, OUT) 
implicit  REAL**  (A-Z) 
if  (TIME  .ge.  TRAMP)  then 

OUT-TIME-TRAMP 
else 

OUT-0 . 0 
end  if 
C 

return 
end 
C     ********************* 

C     ***  TIME  CONSTANT  *** 


c     ********************* 
C 

Subroutine  TCONST(Y0 ,X,TAU,NTIME,NTIM,DELTIM,Y) 

implicit  real**  (A-Z) 

integer*2  NTIME.NTIM 

if  (NTIME  .eq.  1)  Y-YO 

if  (NTIME  .ne.  NTIM)  YO-Y 

DECAY-exp( -DELTIM/TAU) 

Y-Y0+(X-Y0)*(1. -DECAY) 

if  (NTIME  .eq.  1)  Y-YO 

NTIM-NTIME 
C 

return 
end 
C    ********************************************* 

C  *****  First  Order  Derivative  Subroutine  ***** 
C  *****  (Central  Difference  Method)  ***** 
C    ********************************************* 

Subroutine  DERIV(DELTIM, NTIME, NTIM1,IC2,XM1,N0WVAL, XX, XDM1, 
+  XD,XDDM1,XDD, SLOPE) 

implicit  REAL**  (A-Z) 
integer*2  NTIME ,NTIM1 
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if  (NTIME  .eq.  NTIM1)  then 

XX-NOWVAL 
else 
XM1=XX 
XX-NOWVAL 
XDM1-XD 
XDDM1-XDD 
end  if 
C 

XD-(XX-XMl) /DELTIM 
if  (abs(XD)  .It.  l.E-8)  XD«0 . 
if  (NTIME  .eq.  1)  XD=IC2 
XDD- (XD-XDM1 ) /DELTIM 
if  (abs(XDD)  .It.  l.E-8)  XDD=0.0 
C 

NTIM1-NTIME 
C 

XPRED«XX+XD*DELTIM+XDD* ( DELTIM**2 ) /2 . 0 
if  (abs(XFRED)  .It.  l.E-8)  XPRED-0.0 
SLOPE- (XPRED-XM1 ) / (2 . 0*DELTIM) 
if  (abs(SLOPE)  .It.  l.E-8)  SLOPE-0 . 0 
C 

return 
end 
c    *******************************************< 

C    *****  Trapezoidal  Integration  Subroutine  **' 
c  *******************************************, 


Subroutine  INTGRL ( NTIME, NTIM2, DELTIM, IC3, PREVAL , NOWVAL , 
+  CURVAL.OUTOLD.OUTNEW) 

implicit  REAL*4  (A-Z) 
integer*2  NTIME, NTIM2 
C 

if  ((NTIME  .eq.  NTIM2)  .or.  (NTIME  .eq.  1))  then 

CURVAL-NOWVAL 
else 

PREVAL  -  CURVAL 
CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
end  if 

if  (NTIME  .eq.  1)  OUTOLD-IC3 
OUTNEW  -  OUTOLD+(CURVAL+PREVAL)*DELTIM/2. 
NTIM2-NTIME 
C 

return 
end 
C    **************************************** 

C    *****  CLEAR  SCREEN  AND  HOME  CURSOR  ***** 

Q  **************************************** 

subroutine  CLRSCR 
character*!  C1,C2,C3,C4 
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integer*2  IC(A) 

equivalence  (Cl.IC(l) ) , (C2, IC(2) ) , (C3 , IC(3) ) , (CA , IC( A ) ) 

data  IC/16#1B,16#5B,16#32,16#AA/ 
C 
C  ***  Write  Escape  Code  to  Display  *** 

write(*,l)  C1,C2,C3,CA 

1  format(lX.AAl) 
C 

return 
end 

Q  ***************************************** 

C    *****  Position  Cursor  by  Row .Column  ***** 

Q  ***************************************** 

subroutine  GOTOXYC ROW, COLUMN) 

integer*2  IC(A) ,ROW, COLUMN, L 

character*l  C1,C2,C5,C8,LC(5) 

character*5  CBUFF 

equivalence  (CI, IC(1) ) , (C2, IC(2) ) , (C5, IC(3) ) , (C8, IC( A ) ) , 
+  (CBUFF, LC(D) 

data  IC/16#1B,16#5B,16#3B, 16*66/ 
C 

L-10000+100*ROW+COLUMN 
C 
C  ***  Write  Escape  Codes  to  a  Character  Buffer  *** 

write(CBUFF,2)  L 

2  format (15) 
C 

C  ***  Write  Escape  Codes  to  Display  *** 

write(*,3)  C1,C2,LC(2) ,LC(3) ,C5,LC(A) ,LC(5) ,C8 

3  format(lX,8Al,\) 
return 

end 
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APPENDIX  B 
PWM  OPEN  LOOP  TRANSFER  CHARACTERISTICS 


SNOfloatcalls 

SNOdebug 

C 

C      

c    I  I 

C      I   ROSSITTO,  VS   THESIS    PROF  GERBA  04/11/87  | 

C     |_ PWM  TEST  MODULE | 

C 

C      This  version  tests  the  pulse  width  modulator  for  logical 
C      correctness.  POSERR  is  used  as  an  input  and  VIN  is  the 
C      output . 

IMPLICIT  REAL**  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PPLANE , 
+       XTITLE.YTITLE.PTITLE 

REAL**  X( 1010 ), Yl( 1010 ), Y2( 1010 ),Y3( 1010 ),Y4( 1010 ),LINE0( 1010) 

INTEGER*2  NTERMS , IOPORT , MODEL , XLEN , YLEN , NTIME , NUMIT , NTIM1 , 
+         NTIM2 , NTIM3 , NTIMA , DIR, PMODEL , NPTS , NCTR, PPLANE , 
+  SIM2PL.WAVE 

LOGICAL*2  WAITNG, TOGGLE 

CHARACTER* 1  DISOPT.PLOPT 

CHARACTER*6  ANS1,ANS11,ANS21,PRTSEL 

CHARACTER*20  XTITLE, YTITLE 

CHARACTER'S 1  PRTCHR.PTITLE 
C 
C   ...  Introductory  Page  (1  time  good  deal!) 

call  CLRSCR 

write(*,4) 

PAUSE 
C     *************************************** 

C     ***  OPEN/READ/CLOSE  INPUT  DATA  FILE  *** 

Q  *************************************** 

c 

13   open (7, FILE-' PWM. INP' , STATUS- 'OLD' .ACCESS-' SEQUENTIAL' ) 
read(7,1000)  PMODEL , PRTCHR 
read(7,1020)  BEGTIM, FINTIM, MAXITS , SIM2PL 
read (7,1022)  DBAND, PERIOD 
read(7,1028)  KPWM.XO, Y0 ,WFACT 
c lose (7, STATUS-' KEEP ' ) 
C 

Q  ************************************ 

C     ***  DISPLAY  MAIN  MENU  SELECTIONS  *** 


call  CLRSCR 

call  GOTOXY(10,1) 

write(*,5) 
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read(*, '(A)*)  ANSI 
C   ...  Hardware  Options  . . . 

if  ((ANSI  .eq.  'h' )  .or.  (ANSI  .eq.  'H'))  then 
C 
101     call  CLRSCR 

call  GOTOXYU7.24) 

write (*,*)•***  CURRENT  PRINTER  SELECTION  ***' 
call  GOTOXY(20,20) 
write (*,*)  PRTCHR 
call  GOTOXY(10,1) 
write(*,105) 
read(*,'(A)*)  ANS11 
C 
C   ...  Printer  Options  .  .  . 

if  ((ANS11  .eq.  *p')  .or.  (ANS11  .eq.  'P'))  then 
131        call  CLRSCR 
write(*,130) 
read(*, * (A)')  PRTSEL 
C 

if  (PRTSEL  .eq.  '0*)  then 

PRTCHR-'Epson  FX-80  Printer,  single  density' 
PMODEL-0 
elseif  (PRTSEL  .eq.  *1')  then 

PRTCHR- ' Epson  FX-80  Printer,  double  density' 
PMODEL-1 
elseif  (PRTSEL  .eq.  '2')  then 

PRTCHR" ' Epson  FX-80  Printer,  dble  spd.dual  density' 
PMODEL-2 
elseif  (PRTSEL  .eq.  '3')  then 

PRTCHR-'Epson  FX-80  Printer,  quad  density' 
PMODEL-3 
elseif  (PRTSEL  .eq.  '«*)  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  I' 
PMODEL-4 
elseif  (PRTSEL  .eq.  '5')  then 

PRTCHR-'Epson  FX-80  Printer,  plotter  graphics' 
PMODEL-5 
elseif  (PRTSEL  .eq.  '6')  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  II' 
PMODEL-6 
elseif  (PRTSEL  .eq.  '10')  then 

PRTCHR-'Epson  FX-100  Printer,  single  density' 
PMODEL-7 
elseif  (PRTSEL  .eq.  '11')  then 

PRTCHR-'Epson  FX-100  Printer,  double  density' 
PMODEL-11 
elseif  (PRTSEL  .eq.  '12')  then 

PRTCHR-'Epson  FX-100  Printer,  dble  spd.dual  density' 
PMODEL-12 
elseif  (PRTSEL  .eq.  '13')  then 

PRTCHR-'Epson  FX-100  Printer,  quad  density' 
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PMODEL-13 
elseif  (PRTSEL  .eq.  '14')  then 

PRTCHR-'Epson  FX-100  Printer,  CRT  Graphics  I' 
PMODEL-U 
elseif  (PRTSEL  .eq.  '15')  then 

PRTCHR-'Epson  FX-100  Printer,  plotter  graphics' 
PMODEL-15 
elseif  (PRTSEL  .eq.  '16')  then 

PRTCHR-'Epson  FX-100  Printer,  CRT  Graphics  II* 
PMODEL-16 
elseif  (PRTSEL  .eq.  '20')  then 

PRTCHR-'HP  7470A  Graphics  Plotter' 
PMODEL-20 
elseif  (PRTSEL  .eq.  *30')  then 

PRTCHR-'HP  7475A  Graphics  Plotter' 
PMODEL-30 
elseif  (PRTSEL  .eq.  '60')  then 

PRTCHR-'HP  2686A  Laser  Jet  Printer' 
PMODEL-60 
C 
C   ...  Quit  the  Printer  Menu  . . . 

elseif  ((PRTSEL  .eq.  'Q')  .or.  (PRTSEL  .eq.  'q'))  then 

go  to  101 
else 

go  to  131 
endif 
go  to  101 
C 
C   ...  Quit  the  Hardware  Menu  .  .  . 

elseif ((ANS11  .eq.  'q')  .or.  (ANS11  .eq.  *Q*))  then 

go  to  1 
else 

go  to  101 
endif 
C 
C   ...  PWM  Design  Menu  . .  . 

elseif  ((ANSI  .eq.  *p')  .or.  (ANSI  .eq.  'P'))  then 
C 
203     call  CLRSCR 

write (*, 250)  KPWM , DBAND , PERIOD 
read(*. '(A)')  ANS21 
C 

if  (ANS21  .eq.  'KPWM')  then 
call  GOTOXY(2A,l) 

write(*. ' (A\)' ) 'Enter  a  REAL  value  for  KPWM-->  ' 
read(*,*)  KPWM 
go  to  203 
elseif  (ANS21  .eq.  'PERIOD')  then 
call  GOTOXY(24,l) 

write(*. ' (A\)' )'Enter  a  REAL  value  for  PERIOD-->  ' 
read(*,*)  PERIOD 
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go  to  203 
elseif  (ANS21  .eq.  'DBAND')  then 
call  GOTOXY(24,l) 

write(*, * (A\)' ) 'Enter  a  REAL  value  for  DBAND-->  ' 
read(*,*)  DBAND 
go  to  203 
C 
C   ...  Quit  PWM  Design  Menu  . . . 

elseif  (ANS21  .eq.  'Q*)  then 

go  to  1 
else 

go  to  203 
end  if 
C 
C   ...  Simulation  Options  . . . 

elseif  ((ANSI  .eq.  'o')  .or.  (ANSI  .eq.  '0'))  then 
C 

202     call  CLRSCR 
C 

DELTIM-(FINTIM-BEGTIM) / ( 1000 . *SIM2PL) 
if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 
NTERMS«IFIX(FINTIM/DELTIM)+1 
C 

write(* , 240 )  BEGTIM, FINTIM, MAXITS , SIM2PL , 
+  X0,Y0,WFACT, DELTIM, NTERMS 

read(*,'(A)')  ANS21 
C 

if  (ANS21  .eq.  'BEGTIM')  then 
call  GOTOXY(24,l) 

write(*,'(A\)')'Enter  a  REAL  value  for  BEGTIM-->  ' 
read(*,*)  BEGTIM 
go  to  202 
elseif  (ANS21  .eq.  'FINTIM')  then 
call  GOTOXY(24,l) 

write(*,'(A\)') 'Enter  a  REAL  value  for  FINTIM— >  ' 
read(*,*)  FINTIM 
go  to  202 
elseif  (ANS21  .eq.  'MAXITS')  then 
call  GOTOXY(24,1) 

write(*.*(A\)') 'Enter  a  REAL  value  for  MAXITS-->  ' 
read(*,*)  MAXITS 
go  to  202 
elseif  (ANS21  .eq.  'SIM2PL')  then 
call  GOTOXY(24,l) 

write(*,'(A\)*)'Enter  a  INTEGER  value  for  SIM2PL— > 
read(*,*)  SIM2PL 
go  to  202 
elseif  (ANS21  .eq.  *X0*)  then 
call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  X0-->  ' 
read(*,*)  X0 
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go  to  202 
elseif  (ANS21  .eq.  'Y0')  then 
call  GOTOXY(24,l) 

write(*, ' (A\)' )'Enter  a  REAL  value  for  Y0-->  ' 
read(*,*)  Y0 
go  to  202 
elseif  (ANS21  .eq.  'WFACT')  then 
call  GOTOXY(24,l) 
write(*, ' (A\)' ) 'Enter  a  REAL  value  for  WFACT — >  ' 
read(*,*)  WFACT 
go  to  202 
C   ...  Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq.  'Q' )  then 

go  to  1 
else 

go  to  202 
end  if 
C 
C   ...  Input  Waveform  Options  . . . 

elseif  ((ANSI  .eq.  'i')  .or.  (ANSI  ,eq.  *I'))  then 

204     call  CLRSCR 
C 
C 

write(*,260) 
read(*. '(A)')  ANS21 
call  CLRSCR 
C 

if  (ANS21  .eq.  *1')  then 

call  GOTOXY(10,1) 

WAVE-1 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  K-->  ' 

read(*,*)  CONST 

write (*,* (A\)* )*  Enter  a  REAL  value  for  W-->  ' 

read(*,*)  W 

call  GOTOXY(17,4) 

write(*,141)  CONST, W 
141  formatdX, 'POSERR  =',F8,3,'*  SIN( '  ,F8.  3  , '*  t)') 

PAUSE 

go  to  204 
elseif  (ANS21  .eq.  '2')  then 

call  GOTOXY(10,1) 

WAVE-2 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  K — >  ' 

read(*,*)  CONST 

write(*, ' (A\)' )*  Enter  a  REAL  value  for  W-->  ' 

read(*,*)  W 

write(*, ' (A\)' )'  Enter  a  REAL  value  for  TAU-->  ' 

read(*,*)  TAU 

call  GOTOXY(17,4) 

write(*,142)  CONST, TAU, W 
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142 


143 


format( IX, ' POSERR  =',F8.3,'*  EXP(-t/ ' ,F8 . 4 , ' )*SIN( ' ,F8 . 3 , ' *  t)') 
PAUSE 
go  to  204 
elseif  (ANS21  .eq.  '3')  then 
call  GOTOXYUO.l) 
WAVE-3 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  A-->  ' 
read(*,*)  A 

write(*, ' (A\)' )'  Enter  a  REAL  value  for  B— >  ' 
read(*,*)  B 
call  GOTOXY(17,4) 
write(*,143)  A,B 
format (IX, 'POSERR  «\F8.3,'*  t  +',F8.4) 
PAUSE 
go  to  204 
.  Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq.  'Q')  then 

go  to  1 
else 

go  to  204 
end  if 
.  Save  Options  to  File  . . . 
elseif  ((ANSI  .eq.  's')  .or.  (ANSI  .eq.  'S'))  then 

A*************************** ************ 

***  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  *** 
**************************************** 

open(7,FILE-*FWM.INP' , STATUS- *  NEW' ) 

write (7,1000)' PMODEL , PRTCBR 

write ( 7 , 1020 )  BEGTIM, FINTIM .MAXITS , SIM2PL 

write(7,1022)  DBAND, PERIOD 

write(7,1028)  KPWM,X0,Y0,WFACT 

write(7,2000) 

close(7, STATUS-* KEEP' ) 


go  to  1 

.  Run  the  Program  . . . 

elseif  ((ANSI  .eq.  'r')  .or.  (ANSI  .eq.  'R'))  then 
go  to  2 

.  Quit  the  Program  . . . 
elseif  ((ANSI  .eq.  'q')  .or.  (ANSI  .eq.  'Q'))  then 

stop 
else 

go  to  1 
end  if 


2   PI-3. 14159 
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C   ...  Initializations  . . . 

NCTR-0 

NPTS-0 

TSTART-0 . 0 

TOGGLE" . true . 

PPLANE-0 
C 
C  ...  Display  the  simulation  header  . . . 

call  CLRSCR 

call  GOTOXY(10,29) 

write(*,*)  'Simulation  in  Progress' 

DELTIM=(FINTIM-BEGTIM) / ( 1000 . *SIM2PL ) 

if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS=IFIX(FINTIM/DELTIM)+1 

call  GOTOXY(U.l) 

write(*,15)  DELTIM, NTERMS 
15   format(16X, 'Simulation  Step  Size  — >  ',F8.7,'  seconds',/, 
+       17X, 'Total  Number  of  Steps-->  ',14) 

SPACE-DELTIM/2.0 
C 
C   ...  Open/Write/Close  OUTPUT  data  file  . . . 

open (4, FILE- 'PWM. OUT' , STATUS- ' NEW' ) 

write(4,1200)  BEGTIM.FINTIM, MAXITS, SIM2PL, PERIOD, DBAND, 
+  ERRCUT,AGCCUT,ERRSAT,AGCSAT 

close (4, STATUS- 'KEEP') 
C 
C      ********************************** 

C      ***  START  MAIN  SIMULATION  LOOP  *** 
c     ********************************** 

c 

DO  100  NT IME-1, NTERMS 
TIME=(NTIME-1)*DELTIM 
C  ...  Reset  the  saw-tooth  reference  signal  . . . 
if  (TIME  .ge.  TSTART+EERIOD )  then 

TSTART-TSTART+PERIOD 

TOGGLE- . true . 
end  if 
C 

if  (WAVE  .eq.  1)  POSERR«CONST*SIN(W*TIME) 
if  (WAVE  .eq.  2)  POSERR-CONST*exp(-TIME/TAU)*SIN(W*TIME) 
if  (WAVE  .eq.  3)  POSERR=A*TIME+B 
C 

if  (POSERR  .gt.  (0.+DBAND))  then 

DIR-1 

ERROR- abs (KPWM* ( POSERR-DBAND ) ) 
elseif  (POSERR  .It.  (0. -DBAND))  then 

DIR— 1 

ERROR-abs (KPWM* ( POSERR+DBAND ) ) 
else 

ERROR-0 . 
endif 
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call  LIMIT (0..1. .ERROR .ERROR) 
call  RAMP ( TIME, TSTART.NREF) 
VREF=NREF/ PERIOD 
THRESH=1. -ERROR 
C 

C   ...  "WAITING"  is  a  logical  variable  indicating  whether  or  not  a  new 
C       pulse  may  be  generated  . . . 

WAITNG-TOGGLE 
C 

if  (WAITNG)  then 

if  (VREF  .gt.  THRESH)  then 
if  (DIR  .eq.  1)  then 
VTN=150. 
TOGGLE-. false, 
elseif  (DIR  .eq.  -1)  then 
VIN— 150. 
TOGGLE-. false, 
endif 
else 
VIN-0 . 

TOGGLE- . true . 
endif 
endif 
C 

DIRLOG-VIN/150. 
C 

C   ...  Generate  Plotting  Arrays  . . . 
if  (TIME  .ge.  BEGTIM)  then 
NCTR-NCTR+1 

if  (mod(NCTR,SIM2PL)  .eq.  0)  then 
NPTS-NPTS+1 
X(NPTS)-TIME 
Yl(NPTS)=POSERR 
Y2(NPTS)«VREF 
Y3(NPTS) -THRESH 
Y4(NPTS)«DIRLOG 
LINE0(NPTS)-0. 
endif 
endif 
C 

100  CONTINUE 
C 

Q  ******************************** 

C     ***  END  MAIN  SIMULATION  LOOP  *** 

Q  ******************************** 

c 

Q  ****************************** 

C     *****  Plotting  selection  ***** 
C     ****************************** 

c 

C  ***  Clear  Screen  &  Home  Cursor  *** 
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400  call  CLRSCR 
C 

write(*,1305) 
read(*, ' (A)' )  DISOPT 
C 

if  (DISOPT  .  eq.  ' 1*)  then 
MODEL-99 
IOPORT-99 
elseif  (DISOPT  .eq.  '2')  then 
MODEL=PMODEL 
IOPORT-1 

if  ((MODEL  .eq.  20)  .or.  (MODEL  .eq.  30))  IOPORT=9600 
elseif  (DISOPT  .eq.  '3')  then 

GO  TO  13 
elseif  ((DISOPT  .eq.  'Q')  .or.  (DISOPT  .eq.  'q'))  then 

GO  TO  460 
else 

write(*,*)  'Incorrect  display  option  selection,  try  again  !' 
go  to  400 
end  if 
C 

410  call  CLRSCR 

if  (DISOPT  eq.  '2')  then 
call  GOTOXY(20,20) 
write(*,*)  PRTCHR 
call  GOTOXY(l,l) 
endif 

write(*,1300) 
read(*, '(A)*)  PLOPT 
C 

if  ((PLOPT  .eq.  'Q' )  .or.  (PLOPT  .eq.  'q'))  then 

go  to  400 
elseif  (PLOPT  .eq.  '1')  then 
XTITLE-'TIME  (sec)' 
XLEN— 10 

YTITLE-'PWM  PERFORMANCE* 
YLEN-14 
PPLANE-0 

call  MGRAPH(X,Y1,Y2,Y3,Y4,LINE0, DISOPT, KPWM . DBAND , X0 , Y0 , WF ACT) 
else 

go  to  410 
endif 
C 

go  to  400 
460  continue 
C 
c     ***************************** 

C     ***  I/O  FORMAT  STATEMENTS  *** 

Q  ***************************** 


c 


4  format(////,24X, 'PULSE  WIDTH  MODULATOR  DESIGN  AND  ANALYSIS',/, 
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+  26X,'.0pen  Loop  Response  Characteristics' , / , 

+  26X, ' .Automatic  Gain  Control  Simulation',/, 

+  26X, ' .INTEL-8087  Math  Co-processor  version',///, 

+  lOX.'NOTE:  Much  of  the  screen  control  attained  in  this  ',/, 
+  10X,'      program  is  interactive  with  the  DOS  screen  driver',/, 
+  10X,'      ANSI. SYS.   Ensure  your  CONFIG.SYS  file  contains',/, 
+  10X,'      the  statement  "device=ANSI .SYS" . ' , // , 
+  10X,'      The  input  data  file  PWM.INP  must  be  in  the  ',/, 
+  10X, '      default  disk  drive.  The  output  file  PWM.OUT',/, 
+  10X,'      will  be  written  to  the  default  drive.',//) 
C 

5   format(32X, '***  MAIN  MENU  ***',//, 

+       20X,'[H] >  HARDWARE  Configuration  Menu',/, 

+       20X,'[P] >  PWM  Design  Menu' ,/, 

+  .     20X,' [I]—— >  INPUT  Waveform' ,/, 

+       20X,*[O] >  OPTIONS  for  Simulation',/, 

+       20X,'[S] >  SAVE  All  Changes ',/ , 

+       20X, ' [R] >  RUN  Simulation  Program',/, 

+       20X,'[Q] >  QUIT  the  Program*,//, 

+        8X, 'ENTER  SELECTION >',\) 

105     format (3 OX,'***  HARDWARE  MENU  ***' ,//, 

+       20X,'[P] >  PRINTER/ PLOTTER  configuration  change',/, 

+       20X,'[Q] >  QUIT  THIS  MENU',//, 

+        8X, 'ENTER  SELECTION >',\) 

1000  format(lX,I3,2X,A50) 

1020  format(lx,3F12.7,lX,I3) 

1022  format(lX,2F12.7) 

1028  format( IX, ,«F12. 7) 

2000  formate  IX, 'END  OF  FILE') 
C 

130   FORMAT ( 24X, '***  PRINTER  OPTIONS  MENU  ***',//, 

+   15X,'[0]  — >  Epson  FX-80  Printer,  single  density',/, 

+   15X,'tl]  "->  Epson  FX-80  Printer,  double  density',/, 

+   15X,'[2]  — >  Epson  FX-80  Printer,  dble  spd.dual  density',/, 

+   15X,'[3]  — >  Epson  FX-80  Printer,  quad  density',/, 

+  15X,*[4]  -->  Epson  FX-80  Printer,  CRT  Graphics  I',/, 

+   15X,'[5]  — >  Epson  FX-80  Printer,  plotter  graphics',/, 

+  15X,'[6]  — >  Epson  FX-80  Printer,  CRT  Graphics  11*,/, 

+   15X,'[10]  ->  Epson  FX-100  Printer,  single  density',/, 

+   15X,'[11]  ->  Epson  FX-100  Printer,  double  density*,/, 

+  15X,'[12]  ->  Epson  FX-100  Printer,  dble  spd.dual  density',/, 

+   15X,'[13]  ->  Epson  FX-100  Printer,  quad  density',/, 

+   15X,'[14]  ->  Epson  FX-100  Printer,  CRT  Graphics  I',/, 

+   15X,'[15]  ->  Epson  FX-100  Printer,  plotter  graphics',/, 

+   15X,*[16]  ->  Epson  FX-100  Printer,  CRT  Graphics  11',/, 

+   15X,'[20]  ->  HP  7470A  Graphics  Plotter',/, 

+   15X,'[30]  ->  HP  7A75A  Graphics  Plotter',/, 

+   15X,'[60]  ->  HP  2686A  Laser  Jet  Printer  (NPS  installation)',/, 

+   15X,'[Q]  — >   QUIT  THIS  MENU' ,//, 

+  3X, 'Enter  Printer  Selection  Integer  or  Q  to  QUIT  >  ',\) 
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240   format(12X,'***  SIMULATION  OPTIONS  MENU  ****,//, 

+  1X,F12.7,1X, ' [BEGTIM]   Start  Time  of  Plotting  Window',/, 

+  1X,F12.7,LX, ' [FINTIM]   Stop  Time  of  Plotting  Window',/, 

+  1X,F12.7,1X, * [MAXITS]   Max  Number  of  Simulation  Iterations',/, 

+  10X.I3.1X, ' [SIM2PL]   Ratio:  Points  Simulated/Plotted',/, 

+  1X.F12.7.1X, ' [X0]      X  Coordinate  for  Plotting  Origin',/, 

+  1X,F12.7,1X, ' [Y0]      Y  Coordinate  for  Plotting  Origin',/, 

+  1X.F12.7.1X,' [WFACT]    Plotting  Scaling  Factor',/, 

+  1AX,*[Q]        QUIT  THIS  MENU',///, 

+  15X, 'Computed  simulation  step  size  >  ',F8.7,  'seconds',/, 

+  15X, 'Computed  total  number  of  steps >  ',14,//, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 

250   format(///,23X,'***  PWM  DESIGN  MENU  ***',//, 
+  1X,F12.7,1X, ' [KPWM]     PWM  Amplifier  Gain' ,/, 
+  1X.F12.7.1X, ' [DBAND]    PWM  Amplifier  Deadband' ,/ , 
+  1X.F12.7, IX,' [PERIOD]   Period  of  PWM  Reference  Cycle',/, 
+  14X,'[Q]        QUIT  THIS  MENU',//, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 
C 

260   format(///,13X, '***  INPUT  WAVEFORM  OPTIONS  MENU  ***',//, 
+10X,'[1]        POSERR-K*sin(W*t)* ,/, 
+  10X,'[2]       POSERR-K*exp(-t/TAU)*sin(W*t)' ,/, 
+  10X,'[3]       POSERR-A*t+B ' , / , 
+  10X,*[Q]       QUIT  THIS  MENU',//, 

+  IX, 'Enter  [1,2,Q]  >  ',\) 

C 

1200  format(20X, 'PULSE  WIDTH  MODULATOR  ANALYSIS',//, 

+  1X,F12.7,1X,* [BEGTIM]   Start  Time  of  Plotting  Window*,/, 
+  1X.F12.7, IX, ' [FINTIM]   Stop  Time  of  Plotting  Window',/, 
+  1X.F12.7.1X, ' [MAXITS]   Max  Number  of  Simulation  Iterations',/, 
+  10X,I3,1X, ' [SIM2PL]   Ratio;  Points  Simulated/Plotted',/, 
+  1X,F12.7,1X,' [PERIOD]   Period  of  PWM  Reference  Cycle*,/, 
+  1X.F12.7, IX, ' [DBAND]    Position  Feedback  Deadband',/, 
+  1X,F12.7,1X,' [KPWM]    PWM  Amplifier  Gain') 
C 

1205  F0RMAT(1X,F8.6,1X,1P5E12.3) 

1300  FORMAT(/////,2X, 'The  following  are  plotting  options',//, 
+  5X,'[1]  PWM  Performance* ,/, 

+  5X.'[Q]  QUIT  THIS  MENU',//, 

+  2X, 'Enter  selection  [1,Q]  >  ',\) 

C 

1305  FORMAT ( /////, 2X, 'Display  options:',/, 
+  5X,'[1]  MONITOR* ,/, 

+  5X,'[2]  PRINTER',/, 

+  5X,'[3]  RETURN  TO  START-UP  MENU  (RE-INITIALIZE)',/, 

+  5X,'[Q]  QUIT  THE  PROGRAM',//, 

+  2X, 'Enter  selection  [1,2,3,Q]  >  *,\) 

C 

1500  fonnat(lX,I3,2X,A50) 
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STOP 
END 


Q        ******************************** 

C   *****  PLOTTING  SUBROUTINES  ***** 
C   *****(single  function  plot)***** 

Q         ******************************** 

Subroutine  GRAPH (X.Y) 
C 

implicit  REAL*4  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PPLANE , 
+       XTITLE, YTITLE, PTITLE 
real*4  X(1010) , Y(1010) 

integer*2  NPTS , IOPORT .MODEL , XLEN , YLEN , PPLANE , NCHAR 
character*20  XTITLE, YTITLE 
character*51  PTITLE 
C 

AS PRAT-. 65 
CHARHT- . 22 

PTX-1 . 5+(6 . -PLEN*ASPRAT*CHARHT) /2 . 
PTY-5 . 5 

NCBAR-i fix (PLEN) 
C 

call  PLOTS (0, IOPORT, MODEL) 

call  FACTOR (1.00) 

call  ASPECT (ASPRAT) 

call  SCALE (X, 6., NPTS, 1) 

call  SCALE(Y,4. ,NPTS,1) 

call  STAXIS(.15,.22,.10,.080,3) 

FIRSTX  -  X(NPTS+1) 

if  (PPLANE  .eq.  1)  then 
DELTAX-X(NPTS+2) 

else 

X(NPTS+2)-(X(NPTS)-X(NPTS+l))/6. 
DELTAX  -  X(NPTS+2) 

endif 

FIRSTY  -  Y(NPTS+1) 

DELTAY  -  Y(NPTS+2) 
call  AXISQ. 0,1.0, XTITLE, XLEN, 6. ,0. .FIRSTX, DELTAX) 
call  STAXIS(.15,.22r .10, .080,2) 

call  AXIS(1.,1. , YTITLE, YLEN, 4. ,90. , FIRSTY, DELTAY) 
call  SYMBOL ( PTX, PTY , CHARHT , PTITLE , 0 . , NCHAR) 
if  (PPLANE  .eq.  1)  then 

call  SYMBOL(3.0,5.25,.18, '(' ,0. ,1) 

call  NUMBER(999. ,5.25, .18, BEGTIM, 0. ,4) 

call  SYMBOL(999. ,5.25, .18,'  -  \0.,3) 

call  NUMBER(999. ,5.25, . 18, FINTIM, 0. ,4) 

call  SYMBOL(999. ,5.25, .18,'  seconds) ' ,0. , 9) 
endif 
call  PLOTU.  ,1.,-13) 
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call  LINE (X,Y,NPTS, 1,0,0) 

call  PLOT(0. 0,0. 0,999) 
C 

MODEL=99 

IOPORT=99 
C 

RETURN 

END 
C   ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
C  *****(multi-  function  plot)***** 
c  ******************************** 

Subroutine  MGRAPH (X , Y5 , Y6 , Y7 , Y8 , LINE0 , DISOPT , KPWM , DBAND , 
+  X0.Y0.WFACT) 

C 

implicit  REAL*A  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS . IOPORT , MODEL , XLEN , YLEN , PLEN , PPLANE , 
+       XTITLE.YTITLE.PTITLE 
real**  X(1010) ,Y5( 1010) ,Y6( 1010) ,Y7( 1010) ,Y8( 1010) .LINE0C1010) 
integer*2  NPTS , IOPORT .MODEL , XLEN , YLEN , PPLANE 
character*l  DISOPT 
character*3  ANS 
character*20  XTITLE, YTITLE 
character*51  PTITLE 
C 

C       WFACT-,5 
C   . . .Time  axis  . . . 

X( NPTS+1) -BEGTIM 
FIRSTX  -  BEGTIM 
X (NPTS+2 )-(BEGTIM-FINTIM) / 10  . 
DELTAX  ■=  (FINTIM-BEGTIM)/10. 
C 

call  SCALE (Y5, A. , NPTS, 1) 
FIRSY5-Y5( NPTS+1) 
DELTY5-Y5( NPTS+2) 
LINE0 (NPTS+1 )-Y5(NPTS+l ) 
LINE0 (NPTS+2 )-Y5 (NPTS+2 ) 
Y6(NPTS+D  — 1.0 
Y6( NPTS+2) -.2 
Y7  (NPTS+1 )— 1.0 
Y7( NPTS+2) -.2 
Y8  ( NPTS+1 )  — 12.0 
Y8 (NPTS+2 )-l. 
CALL  PLOTS (0, IOPORT, MODEL) 
CALL  FACTOR (WF ACT) 
if  (DISOPT  .eq.  *1')  then 

call  PLOT(2.5,l.,-13) 
elseif  (DISOPT  .eq.  '2')  then 

call  PLOT(X0/WFACT,Y0/WFACT,-13) 
C  ...  Draw  a  border  . . . 

call  PLOT(16.0,0.0,2) 
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call  PL0TU6.  0,12.0,2) 

call  PLOK0. 0,12.0,2) 

call  PLOT(0.0,0.0,2) 
Redefine  origin  . . . 

call  PLOT( 1.3, 11.0,-13) 
endif 

CALL  STAXIS(.20, .27, .16, .080,2) 

CALL  AXIS(0. 0,0.0, 'TIME  (sec ) ' , -10 , 10 . , 270 . ,FIRSTX,DELTAX) 

CALL  STAXIS ( . 20 , . 27 , . 16 , . 080 , 1 ) 

CALL  AXIS ( 0 . , 0 . , ' ERROR  SIGNAL ' , 12 , A . , 0 . , FIRSY5 , DELTY5 ) 

CALL  LINE(Y5,X,NPTS, 1,0,0) 

CALL  CURVE (LINE0,X,NPTS, - . 1) 

CALL  AXISC5. ,0. , 'REFERENCE  SIGNAL' ,16,5. ,0. ,0. , .2) 
CALL  LINE(Y6,X,NPTS, 1,0,0) 

CALL  AXIS(5. ,-10. , 'THRESHOLD  VOLTAGE' ,-17,5. ,0. ,0., .2) 

CALL  NEWPEN(2) 

CALL  LINE(Y7,X,NPTS, 1,0,0) 

CALL  NEWPEN(l) 

CALL  STAXIS(.20,.27,.13,.080,-1) 

CALL  AXIS( 11. ,0.,* DIRECTIONAL  LOGIC , 17 ,2. , 0 . ,-1. , 1. ) 

CALL  LINE(Y8,X,NPTS, 1,0,0) 

PTITLE-'PWM  OPEN  LOOP  PERFORMANCE' 

call  SYMBOL(l«.2,-1.3, .35,PTITLE,270. ,26) 

call  SYMBOLQ3. 6,-1.0 

call  NUMBER(13.6,999. 

call  SYMBOL(13.6,-5.0 

call  NUMBER(13.6,999. 


.3, 'GAIN  -  ',270., 7). 
.3,KPWM,270. ,2) 
.3,'DEAD  ZONE  -  ',270., 12) 
.3,DBAND,270. ,2) 


CALL  PLOT(0. 0,0. 0,999) 
C 

MODEL-99 

IOPORT-99 
C 

RETURN 

END 

Q  ************************************************* 

C    *****  Cutoff-Saturation  Limiting  Subroutine  ***** 
C    ************************************************* 

Subroutine  LIMIT (RSAT , RCUT , INPUT , OUT ) 
implicit  REAL*4  (A-Z) 
if  (INPUT  .le.  RSAT)  then 

OUT-RSAT 
elseif  (INPUT  .ge.  RCUT)  then 

OUT-RCUT 
else 
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OUT- INPUT 
end  if 


C 


return 
end 
r    ************************************** 

C    *****  Function  Switch  Subroutine  ***** 

Q  ************************************** 

Subroutine  FCNSW(X1 ,X2,X3,X4 ,OUT) 
implicit  REAL*4  (A-Z) 
if  (XI  .It.  0.0)  then 
OUT-X2 

. eq .  0.0)  then 


elseif  (XI 

OUT-X3 

else 

OUT-XA 

end  if 

return 

end 

c     ************************************ 

C    *****  step  function  Subroutine  ***** 
c    ************************************ 

Subroutine  STEP ( TIME, TSTEP, OUT) 
implicit  R£AL*4  (A-Z) 
if  (TIME  .ge.  TSTEP)  then 

OUT- 1.0 
else 

OUT-0 . 0 
end  if 
C 

return 
end 
c    ******************************** 

C    *****  Deadspace  Subroutine  ***** 
c    ******************************** 

Subroutine  DEADSP(P1 , P2 , VSGDEL , VSGERR ) 
implicit  REAL**  (A-Z) 
if  (VSGDEL  .gt.  P2)  then 

VSGERR-VSGDEL-P2 
elseif  (VSGDEL  .It.  PI)  then 

VSGERR-VSGDEL-P1 
else 

VSGERR-0 . 0 
end  if 


return 

end 
C     ********************** 
C    *****  Ramp  Subroutine 
c    ********************** 
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Subroutine  RAMP (TIME, TRAMP, OUT) 
implicit  REAL*4  (A-Z) 
if  (TIME  .ge.  TRAMP)  then 

OUT=TIME- TRAMP 
else 

OUT-0 . 0 
end  if 
C 

return 
end 

Q  ********************* 

C     ***  TIME  CONSTANT  *** 

Q  ********************* 

c 

Subroutine  TCONST ( IC , X , TAU , NTIME , NTIM , DELTIM , Y ) 

implicit  real**  (A-Z) 

integer*2  NTIME, NTIM 

if  (NTIME  .ne.  NTIM)  IC-Y 

DECAY-exp( -DELTIM/TAU ) 

Y=X-(X-IC)*DECAY 

if  (NTIME  .eq.  1)  Y-IC 
.  NTIM-NTIME 
C 

return 
end 
c    ********************************************* 

C    *****  First  Order  Derivative  Subroutine  ***** 

Q  ********************************************* 

Subroutine  DERIV(DELTIM, NTIME, NTIM1, IC2 , XM1 , NOWVAL , XX, XDM1 , 
+  XD,XDDM1,XDD, SLOPE) 

implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM1 
C 

if  (NTIME  .eq.  NTIM1)  then 

XX-NOWVAL 
else 
XM1-XX 
XX-NOWVAL 
XDM1-XD 
XDDM1-XDD 
end  if 
C 

XD-(XX-XMl) /DELTIM 
if  (abs(XD)  .It.  l.E-8)  XD-0. 
if  (NTIME  .eq.  1)  XD«IC2 
XDD» (XD-XDM1 ) /DELTIM 
if  (abs(XDD)  .It.  l.E-8)  XDD-0.0 
C 

NTIM1-NTIME 
C 

XPRED-XX+XD*DELTIM+XDD* (DELTIM**2 ) /2 . 0 
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if  (abs(XFRED)  .It.  l.E-8)  XPRED-0 . 0 
SLOPE- (XPRED-XM1) / (2 . 0*DELTIM) 
if  (abs(SLOPE)  .It.  l.E-8)  SLOPE=0.0 
C 

return 
end 
r    ********************************************** 

C    *****  Trapezoidal  Integration  Subroutine  ***** 

Q  ********************************************** 

Subroutine  INTGRL (NTIME , NTIM2 , DELTIM , IC3 , FREVAL , NOWVAL , 
+  CURVAL,OUTOLD,OUTNEW) 

implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM2 
C 

if  (NTIME  .eq.  NTIM2)  then 

CURVAL-NOWVAL 
else 

PREVAL  -  CURVAL 
CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
end  if 

if  (NTIME  ;eq.  1)  OUTOLD-IC3 
OUTNEW  -  0UT0LD+(CURVAL+PREVAL)*DELTIM/2. 
NTIM2-NTIME 
C 

return 
end 
n    **************************************** 

c     *****  CLEAR  SCREEN  AND  HOME  CURSOR  ***** 


C 


subroutine  CLRSCR 

character*l  C1,C2,C3,C4 

integer*2  IC(4) 

equivalence  (CI , IC ( 1 ) ) , (C2 , IC ( 2 ) ) , ( C3 , IC ( 3 ) ) , (C4 , IC ( 4 ) ) 

data  IC/16#1B,16#5B,16#32,16#4A/ 
C 
C  ***  Write  Escape  Code  to  Display  *** 

write(*,l)  C1,C2,C3,C4 
1  format(lX,4Al) 
C 

return 

end 
c    ***************************************** 

C    *****  Position  Cursor  by  Row, Column  ***** 
c    ***************************************** 

subroutine  GOTOXY( ROW, COLUMN) 
integer*2  IC ( 4 ) , ROW , COLUMN , L 
character*l  C1,C2,C5,C8,LC(5) 
character*5  CBUFF 

equivalence  (CI , IC ( 1 ) ) , (C2 , IC ( 2 ) ) , (C5 , IC ( 3 ) ) , (C8 , IC ( 4 ) ) , 
+  (CBUFF, LC(l)) 
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data  IC/16#1B,16#5B,16#3B,16#66/ 
C 

L=10000+100*ROW+COLUMN 
C 
C  ***  Write  Escape  Codes  to  a  Character  Buffer  *** 

write(CBUFF,2)  L 

2  format(I5) 
C 

C  ***  Write  Escape  Codes  to  Display  *** 

write(*,3)  C1,C2,LC(2) ,LC(3) ,C5rLC(4) ,LC(5) ,C8 

3  format(lX,8Al,\) 
return 

end 
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APPENDIX  C 
LUMPED  PARAMETER  MODEL  SIMULATION  PROGRAM 


SNOfloatcalls 

SNOdebug 

C 

C      

C      I 

C      |   ROSSITTO,  VS   THESIS    PROF  GERBA   03/26/87 

C     I  LINEARIZED  MODEL 


C 

C      This  program  simulates  the  averaged  parameter  model  configured 

C      for  position  control.  Options  are  available  to  the  user  for 

C      Pulse  Width  Modulation,  Relay,  or  Saturating  Amplifier  control. 

C      Step,  Ramp,  &  Sinusoidal  Responses  are  available.  Both  second 

C      and  third  order  models  may  be  analyzed. 

IMPLICIT  REAL*4  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PLEN1 , 
+       XTITLE,YTITLE,PTITLE,PTIT1 

REAL*4  X( 1010 ), Yl ( 1010 ), Y2( 1010 ),Y3( 1010 ),Y4( 1010) 

INTEGER*2  NTERMS , IOPORT , MODEL , XLEN , YLEN , NTIME , NUMIT , NTIM1 , 
+         NTIM2 , NTIM3 , NTIMA , DIR, PMODEL , NPTS , NCTR, PPLANE . 
+         SIM2PL , ECTR , EDCTR , NUMBER , NDIM , CTR , ELEMNT , SYSORD , TEMORD 

LOGICAL*2  WAITNG, TOGGLE 

CHARACTER* 1  DISOPT.PLOPT 

CHARACTER*6  ANS1.ANS11 ,ANS21,ANS27 , PRTSEL , NONLIN 

CHARACTER* 15  TYPE, TYPE 1 

CHARACTER*25  XTITLE , YTITLE , NLCHAR 

CHARACTER*51  PRTCHR, PTITLE.PTIT1 
C 
C   ...  Introductory  Page  (1  time  good  deal!) 

call  CLRSCR 

write(* , A ) 

PAUSE 
c     *************************************** 

C     ***  OPEN /READ /CLOSE  INPUT  DATA  FILE  *** 
c     *************************************** 

C 
13   open(7,FILE-'LM.INP* , STATUS- ' OLD ' .ACCESS-' SEQUENTIAL' ) 

read (7, 1000)  PMODEL , PRTCHR 

read(7,1020)  BEGTIM, FINTIM, MAXITS,SIM2PL 

read(7,1022)  KPWM,KV,E0 ,EDOT0 

read(7,1024)  R,L, J,F,KT,KB,KP 

read (7, 1026)  PERIOD , DBAND , XORG , YORG 

read(7,1028)  KA, SYSORD 

read(7 , 1030 )  TYPE , STPMAG , RSLOPE , SINAMP 
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read(7,1032)  SINFRQ.SINPHA 
close(7,STATUS='KEEP' ) 

C 

Q        ************************************ 

C     ***  DISPLAY  MAIN  MENU  SELECTIONS  *** 
C      ************************************ 

c 

1   call  CLRSCR 

call  GOTOXY(8,l) 
write(*,5) 
read(*,'(A)*)  ANSI 
C   ...  Hardware  Options  . . . 

if  ((ANSI  .eq.  'h' )  .or.  (ANSI  .eq.  'H'))  then 
C 
101     call  CLRSCR 

call  GOTOXYU7.24) 

write (*,*)•***  CURRENT  PRINTER  SELECTION  ***' 
call  GOTOXY(20,20) 
write (*,*)  PRTCHR 
call  GOTOXYQO.l) 
write(*,105) 
read(*,'(A)')  ANS11 
C 
C   ...  Printer  Options  . . . 

if  ((ANS11  .eq.  'p')  .or.  (ANS11  .eq.  'P'))  then 
131        call  CLRSCR 
write(*,130) 
read(*, '(A)')  PRTSEL 
C 

if  (PRTSEL  .eq.  '0')  then 

PRTCHR-'Epson  FX-80  Printer,  single  density' 
PMODEL-0 
elseif  (PRTSEL  .eq.  '1')  then 

PRTCHR- ' Epson  FX-80  Printer,  double  density' 
PMODEL-1 
elseif  (PRTSEL  .eq.  '2')  then 

PRTCHR- 'Epson  FX-80  Printer,  dble  spd.dual  density' 
PMODEL-2 
elseif  (PRTSEL  .eq.  '3')  then 

PRTCHR- 'Epson  FX-80  Printer,  quad  density' 
PMODEL-3 
elseif  (PRTSEL  .eq.  '4')  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  I' 
PMODEL-A 
elseif  (PRTSEL  .eq.  '5')  then 

PRTCHR-'Epson  FX-80  Printer,  plotter  graphics' 
PMODEL-5 
elseif  (PRTSEL  .eq.  '6')  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  II' 
PMODEL-6 
elseif  (PRTSEL  .eq.  '10')  then 
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PRTCHR='Epson  FX-100  Printer,  single  density' 
PMODEL-7 
elseif  (PRTSEL  .eq.  '11*)  then 

PRTCHR-'Epson  FX-100  Printer,  double  density' 
PMODEL=ll 
elseif  (PRTSEL  ,eq.  '12')  then 

PRTCHR-'Epson  FX-100  Printer,  dble  spd.dual  density' 
PMODEL-12 
elseif  (PRTSEL  .eq.  '13')  then 

PRTCHR-'Epson  FX-100  Printer,  quad  density' 
PMODEL-13 
elseif  (PRTSEL  .eq.  *14')  then 

PRTCHR=' Epson  FX-100  Printer,  CRT  Graphics  I* 
PMODEL-14 
elseif  (PRTSEL  .eq.  '15')  then 

PRTCHR-'Epson  FX-100  Printer,  plotter  graphics' 
PMODEL-15 
elseif  (PRTSEL  .eq.  '16')  then 

PRTCHR-'Epson  FX-100  Printer,  CRT  Graphics  II' 
PMODEL-16 
elseif  (PRTSEL  .eq.  '20')  then 

PRTCHR-'HP  7470A  Graphics  Plotter' 
PMODEL-20 
elseif  (PRTSEL  .eq.  '30')  then 

PRTCHR-'HP  7475A  Graphics  Plotter* 
PMODEL-30 
elseif  (PRTSEL  .eq.  '60')  then 

PRTCHR-'HP  2686A  Laser  Jet  Printer' 
PMODEL-60 
C 
C   ...  Quit  the  Printer  Menu  . . . 

elseif  ((PRTSEL  .eq.  'Q')  .or.  (PRTSEL  .eq.  'q'))  then 

go  to  101 
else 

go  to  131 
endif 
go  to  101 
C 
C   ...  Quit  the  Hardware  Menu  . . . 

elseif((ANSll  .eq.  'q')  .or.  (ANS11  .eq.  'Q'))  then 

go  to  1 
else 

go  to  101 
endif 
C 
C   ...  Motor  Parameters  . . . 

elseif  ((ANSI  .eq.  'm' )  .or.  (ANSI  .eq.  'M'))  then 
C 
201     call  CLRSCR 

write(*,230)  KT,KB,R,L, J,F,KP,KV,SYSORD 
read(*,'(A)')  ANS21 
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if  (ANS21  .eq.  'KT')  then 

call  G0T0XY(2«,1) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  KT-->  ' 

read(*,*)  KT 

go  to  201 
elseif  (ANS21  .eq.  'KB')  then 

call  GOTOXY(24,l) 

write (*,' (A\)' ) 'Enter  a  REAL  value  for  KB-->  ' 

read(*,*)  KB 

go  to  201 
elseif  (ANS21  .eq.  'R' )  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  R-->  ' 

read(*,*)  R 

go  to  201 
elseif  (ANS21  .eq.  'L')  then 

call  GOTOXY(24,l) 

write(*, ' (A\ ) ' ) 'Enter  a  REAL  value  for  L — >  ' 

read(*,*)  L 

go  to  201 
elseif  (ANS21  .eq.  'J')  then 

call  GOTOXY(24,l) 

write (*,' (A\)' ) 'Enter  a  REAL  value  for  J— >  ' 

read(*,*)  J 

go  to  201 
elseif  (ANS21  .eq.  'F')  then 

call  G0T0XYC2A.1) 

write (*,' (A\)' )' Enter  a  REAL  value  for  F— >  ' 

read(*.*)  F 

go  to  201 
elseif  (ANS21  .eq.  'KP' )  then 

call  G0T0XY(24,1) 

write (*,* (A\)' )' Enter  a  REAL  value  for  KP-->  ' 

read(*,*)  KP 

go  to  201 
elseif  (ANS21  .eq.  *KV' )  then 

call  GOTOXY(24,l) 

write(*,'(A\)*)'Enter  a  REAL  value  for  KV— >  * 

read(*,*)  KV 

go  to  201 
elseif  (ANS21  .eq.  'SYSORD')  then 

call  G0T0XY(24,1) 
write(*.'(A\)')*Enter  an  INTEGER  value  (2  or  3)  for  SYSORD— > 

read(*,*)  TEMORD 

if  ((TEMORD  .ne.  2)  .and.  (TEMORD  .ne.  3))  then 
call  CLRSCR 
call  GOTOXYU0.10) 

write(*,*)  "The  System  Order  may  be  2  or  3  only!!' 
call  G0T0XY(22,1) 
PAUSE 
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else 

SYSORD=TEMORD 
endif 
go  to  201 
C   ...  Quit  Motor  Parameters  Menu  . . . 
elseif  (ANS21  .eq.  'Q')  then 

go  to  1 
else 

go  to  201 
end  if 
C 
C   ...  NON-LINEAR  ELEMENT  SELECTION  MENU 


C 


elseif  ((ANSI  .eq.  'n' )  .or.  (ANSI  .eq.  'N'))  then 
14    call  CLRSCR 

call  GOTOXY(21,l) 
write(*,272)  NLCHAR 
call  GOTOXYU.l) 
write(*,270) 
read(*, ' (A) ' )  ANS27 
. . .  RELAY  AS  NON-LINEAR  ELEMENT  . . . 

if  ((ANS27  .eq.  'r')  .or.  (ANS27  .eq.  'R'))  then 
ELEMNT-1 
NLCBAR-' RELAY' 
291       call  CLRSCR 
NONLIN='R' 
write (*, 290)  DBAND 
read(*,'(A)')  ANS21 

if  (ANS21  .eq.  'DBAND')  then 

call  GOTOXY(24,l) 

write(*. ' (A\)' ) 'Enter  a  REAL  value  for  DBAND-->  ' 

read(*,*)  DBAND 

go  to  291 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 

else 

go  to  291 
endif 
. . .  PULSE  WIDTH  MODULATOR  AS  NON-LINEAR  ELEMENT  . . . 

elseif  ((ANS27  .eq.  'p' )  .or.  (ANS27  .eq.  'P'))  then 
ELEMNT-3 

NLCHAR«='  PULSE  WIDTH  MODULATOR' 
301       call  CLRSCR 
NONLIN-'P* 

write(*,300)  DBAND , PERIOD , KPWM 
read(*,'(A)')  ANS21 

if  (ANS21  .eq.  'DBAND')  then 
call  GOTOXY(24,1) 
write(*, ' (A\)* )' Enter  a  REAL  value  for  DBAND-->  ' 
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read(*,*)  DBAND 
go  to  301 
elseif  (ANS21  .eq.  'PERIOD')  then 
call  GOTOXY(24,1) 

write (*, ' (A\)' ) 'Enter  a  REAL  value  for  PERI0D-->  ' 
read(*,*)  PERIOD 
go  to  301 
elseif  (ANS21  .eq.  'KPWM' )  then 
call  GOTOXY(24,l) 

write(*p ' (A\)' ) 'Enter  a  REAL  value  for  KPWM-->  ' 
read(*,*)  KPWM 
go  to  301 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  301 
endif 
C 
C   ...  SATURATING  AMPLIFIER  AS  NON-LINEAR  ELEMENT  . . . 

elseif  ((ANS27  .eq.  'a')  .or.  (ANS27  .eq.  'A'))  then 
ELEMNT-2 

NLCHAR-' SATURATING  AMPLIFIER' 
281       call  CLRSCR 
NONLIN-'A* 

write(*,280)  DBAND.KA 
read(*,'(A)')  ANS21 
C 

if  (ANS21  .eq.  'DBAND')  then 
call  GOTOXY(24,l) 

write(*, ' (A\ )') 'Enter  a  REAL  value  for  DBAND— >  ' 
read(*,*)  DBAND 
go  to  281 
elseif  (ANS21  .eq.  'KA')  then 
call  GOTOXY(24,l) 

write(*,'(A\)' ) 'Enter  a  REAL  value  for  KA— >  ' 
read(*,*)  KA 
go  to  281 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  281 
endif 
C 

elseif  ((ANS27  .eq.  'q')  .or.  (ANS27  .eq.  *Q'))  then 

go  to  1 
else 

go  to  14 
endif 
C 
C   ...  Simulation  Options  . . . 

elseif  ((ANSI  .eq.  'o')  .or.  (ANSI  .eq.  '0'))  then 
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c 

202     call  CLRSCR 
C 


DELTIM=(FINTIM-BEGTIM) / ( 1000 . *SIM2PL) 

if  (FINTIM/DELTIM  ,gt.  MAXITS)  DELTIM  =FINTIM/MAXITS 

NTERMS«IFIX(FINTIM/DELTIM)+1 

write(*,240)  BEGTIM, FINTIM, MAXITS, SIM2PL, E0  .EDOTO  .XORG, YORG, 

DELTIM, NTERMS 
read(*,'(A)')  ANS21 

if  (ANS21  .eq.  'BEGTIM')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' )' Enter  a  REAL  value  for  BEGTIM— >  ' 

read(*,*)  BEGTIM 

go  to  202 
elseif  (ANS21  .eq.  'FINTIM')  then 

call  GOTOXYC24.1) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  FINTIM— >  ' 

read(*,*)  FINTIM 

go  to  202 
elseif  (ANS21  .eq.  'MAXITS')  then 

call  GOTOXYC24.1) 

write(*. *(A\)' ) 'Enter  a  REAL  value  for  MAXITS— >  ' 

read(*,*)  MAXITS 

go  to  202 
elseif  (ANS21   eq.  'SIM2PL')  then 

call  GOTOXY(24,l) 

write(*, '(A\)' ) 'Enter  a  INTEGER  value  for  SIM2PL— >  ' 

read(*,*)  SIM2PL 

go  to  202 
elseif  (ANS21  .eq.  'E0')  then 

call  GOTOXY(24,l) 

write(*, ' (A\) ' ) 'Enter  a  REAL  value  for  E0  (degrees) — >  ' 

read(*,*)  E0 

go  to  202 
elseif  (ANS21  .eq.  'EDOT0')  then 

call  GOTOXY(24,l) 

write(*, ' (A\ ) ' ) 'Enter  a  REAL  value  for  EDOTO  (deg/sec)— > 

read(*,*)  EDOTO 

go  to  202 
elseif  (ANS21  .eq.  'XORG' )  then 

call  GOTOXY(24,l) 

write(*, * (A\)' ) 'Enter  a  REAL  value  for  XORG— >  ' 

read(*,*)  XORG 

go  to  202 
elseif  (ANS21  .eq.  'YORG')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  YORG— >  ' 

read(*,*)  YORG 

go  to  202 
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C   ...  Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq.  *Q')  then 

go  to  1 
else 

go  to  202 
end  if 
C 
C   ...  Command  Input  Selection  . . . 

elseif  ((ANSI  .eq.  'c')  .or.  (ANSI  .eq.  'C'))  then 
C 
203     call  CLRSCR 


C 


write ( * , 245 )  TYPE , STPMAG , RSLOPE , SINAMP , SINFRQ , SINPHA 
read(*, '(A)')  ANS21 

if  (ANS21  .eq.  'TYPE')  then 
call  GOTOXY(24,l) 

write(*,'(A\)') 'Enter  a  STEP,  RAMP,  or  SINE-->  ' 
read(*,'(A)')  TYPE1 

if  ((TYPE1  .ne.  'STEP*)  .and.  (TYPE1  .ne.  'RAMP')  .and. 
(TYPE1  .ne.  'SINE* ))  then 

call  CLRSCR 

call  GOTOXY(IO.IO) 

write(*,*)  'Invalid  Selection  !!!' 

call  GOTOXY(20,1) 

PAUSE 

go  to  203 
else 

TYPE-TYPE 1 
endif 

go  to  203 
elseif  (ANS21  .eq.  'STPMAG')  then 

call  GOTOXY(24,1) 

write(*,'(A\)')'Enter  a  REAL  value  for  STPMAG— >  ' 

read(*,*)  STPMAG 

go  to  203 
elseif  (ANS21  .eq.  'RSLOPE')  then 

call  GOTOXY(24,l) 

write (*, '(A\)' ) 'Enter  a  REAL  value  for  RSLOPE— >  ' 

read(*,*)  RSLOPE 

go  to  203 
elseif  (ANS21  .eq.  'SINAMP')  then 

call  GOTOXY(24,l) 

write(*,'(A\)') 'Enter  a  REAL  value  for  SINAMP— >  ' 

read(*,*)  SINAMP 

go  to  203 
elseif  (ANS21  .eq.  'SINFRQ')  then 

call  GOTOXY(24,l) 

write(*,'(A\)*) 'Enter  a  REAL  value  for  SINFRQ— >  ' 

read(*,*)  SINFRQ 
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go  to  203 
elseif  (ANS21  .eq.  'SINPHA')  then 
call  GOTOXY(24,l) 

write (*,' (A\)' ) 'Enter  a  REAL  value  for  SINPHA— > 
read(*,*)  SINPHA 
go  to  203 
.  Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq.  'Q' )  then 

go  to  1 
else 

go  to  203 
end  if 
.  Save  Options  to  File  . . . 
elseif  ((ANSI  .eq.  's')  .or.  (ANSI  .eq.  'S'))  then 


***  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  *** 


open(7,FILE-'LM.INP' , STATUS- ' NEW' ) 

write (7, 1000)  PMODEL , PRTCHR 

wr ite ( 7 , 1020 )  BEGTIM , FINTIM , MAXITS , SIM2PL 

write(7,1022)  KPWM,KV,E0 ,EDOT0 

write(7,1024)  R,L, J,F,KT,KB,KP 

write (7, 1026)  PERIOD, DBAND , XORG , YORG 

write (7, 1028)  KA.SYSORD 

write (7, 1030)  TYPE,STPMAG,RSLOPE,SINAMP 

write (7, 1032)  SINFRQ, SINPHA 

write(7,2000) 
close (7, STATUS- 'KEEP') 


go  to  1 

.  Run  the  Program  . . . 

elseif  ((ANSI  .eq.  'r')  .or.  (ANSI  .eq.  *R'))  then 
go  to  2 

.  Quit  the  Program  .  .  . 
elseif  ((ANSI  .eq.  'q')  .or.  (ANSI  .eq.  'Q'))  then 

stop 
else 

go  to  1 
end  if 

.  Open  an  Output  Data  File  . . . 
open (4, FILE- 'LM. OUT' , STATUS- *  NEW ' ) 


PI-3. 14159 
N-.l 

.  Initializations 
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NCTR=0 

NPTS-0 

NTIM2-1 

NTIM3=0 

NTIM4=0 

PARG1-0 . 0 

PARG2-0 . 0 

PVAL4-0 . 

CARG1=0 . 0 

CARG2-0 . 0 

CVAL4=0 . 

TOT 1=0.0 

TOT2=0 . 0 

TVAL1=0 . 0 

TVAL2-0 . 0 

TVAL4-0 . 

XM1-0 . 0 

XX-0.0 

XDM1-0 . 0 

XD-0.0 

XDDM1-0 . 0 

XDD-0 . 0 

Xl-0.0 

Fl-0 . 0 

F2-0 . 0 

X3-0.0 

WM1-0 . 0 

WM-0.0 

IM-0. 

IMO-O . 

TSTART-0 . 0 

THEDEG-0 . 0 

TOGGLE- . true . 

PPLANE-0 

NUMBER-0 

NDIM=20 

VIN-0 . 
C 

C   ...  Preliminary  Relationships  . . . 
C   ...  Initial  conditions  for  THETAC fin, degrees)  and  Omega ( fin . degrees > 

E0RAD-10 . *E0*PI/ 180 . 

EDOT0R-10 . *EDOT0*PI / 180  . 

if  (KP  .ne.  0. )  then 
WM0— EDOT0R/KP 
THETA0— E0RAD/KP 

elseif  (KP  . eq.  0.)  then 
WM0— EDOT0R 
THETA0— E0RAD 

endif 

IM0-(VIN-WM0*KB)/R 

X2-WM0 
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PTHETA-THETAO 
TAU1=L/R 
TAU2=J/F 
C 

call  CLRSCR 
C   ...  Output  Simulation  Options  to  Output  Data  File  .  .  . 

write(4,1200)  SYSORD,BEGTIM,FINTIM,MAXITS,SIM2PL,KT,KB,R,L, J,F ,KP, 
+  KV.KA, PERIOD, DBAND , EO , EDOTO 

write ( A , 1201 )  TYPE , STPMAG , RSLOPE , SINAMP , SINFRQ , SINPHA 
C 

C  . . .  Display  the  simulation  header  . . . 
call  CLRSCR 
call  GOTOXY(10,27) 

write(*,*)  'Simulation  in  Progress' 
DELTIM- (FINTIM-BEGTIM) / ( 1000 . *SIM2PL ) 
if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  =FINTIM/MAXITS 
NTERMS«IFIX(FINTIM/DELTIM)+1 
call  GOTOXY(14,l) 
write (*, 15)  DELTIM, NTERMS 
15  format (16X, 'Simulation  Step  Size  — >  ',F9.8,'  seconds',/, 
+       17X, 'Total  Number  of  Steps— >  ',15) 
call  GOTOXY(21,l) 
C 

if  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 

write (*,*)  *  ***  NON-LINEAR  ELEMENT  IS  RELAY  ***' 

elseif  ((NONLIN  .eq.  'a')  .or.  (NONLIN  >eq.  'A*))  then 
write (*,*)  '  ***  NON-LINEAR  ELEMENT  IS  SATURATING  AMPLI 

+FIER  ***' 
elseif  ((NONLIN  .eq.  *p')  .or.  (NONLIN  eq.  'P'))  then 
write(*,*)  '  ***  NON-LINEAR  ELEMENT  IS  PWM  ***' 

else 
write(*,*)  '  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  '  ...  Return  to  Main  Menu  ..." 

PAUSE 
go  to  1 
endif 
C 

SPACE-DELTIM/2.0 
C 
c     ********************************** 

C     ***  START  MAIN  SIMULATION  LOOP  *** 
C     ********************************** 

C 

DO  100  NT IME-1, NTERMS 

TIME- ( NTIME- 1 ) *DELTIM 

NUMIT-0 

THETA-PTHETA 
C 
C     *********************************** 

C     ***  START  INNER  SIMULATION  LOOP  *** 
C     *********************************** 
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c 

200    NUMIT-NUMIT+1 
WM-X2 
C 

C   ...  Command  Input  Signal  Generator  . . . 
if  (TYPE  .eq.  'STEP')  then 

ORDER=STPMAG 
elseif  (TYPE  .eq.  'RAMP')  then 

ORDER=RSLOPE*TIME 
elseif  (TYPE  .eq.  'SINE')  then 

ORDER=SINAMP*sin(SINFRQ*TIME+SINPHA) 
end  if 
C 

THETAF=.1*THETA*180./PI 
OMEGAF- .  1*WM*180  . /PI 
POSERRORDER-KP*THETAF-KV*OMEGAF 
C 

C   ...  Utilization  of  Non-Linear  Element  . . . 
C   ...  PULSE  WIDTH  MODULATOR  . . . 

if  ((NONLIN  .eq.  'p')  .or.  (NONLIN  .eq.  'P'))  then 
call  PWMOD( TIME, NUMIT , TSTART , PERIOD, TOGGLE .POSERR, 
+  DBAND, VIN ,VREF, THRESH, KPWM) 

C   ...  IDEAL  RELAY  . . . 

elseif  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 
call  RELAY ( POSERR , DBAND , VIN ) 
C   ...  SATURATING  AMPLIFIER  ... 

elseif  ((NONLIN  .eq.  *a')  .or.  (NONLIN  .eq.  'A'))  then 

call  AMPLIF( POSERR, DBAND, KA, VIN) 
else 

call  G0T0XY(21,1) 

write(*,*)  *  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  '  ...  Return  to  Main  Menu  ...' 

PAUSE 
go  to  1 
endif 
C 

EN-VIN-WM*KB 
C 

if  (SYSORD  .eq.  3)  then 

call  TCONST(IMO,EN/R,TAU1,NTIME,NTIM1,DELTIM,IM) 
elseif  (SYSORD  .eq.  2)  then 

IM-EN/R 
else 

call  CLRSCR 
call  GOTOXY(10,10) 

write(*,*)  'SYSTEM  ORDER  IS  NOT  2  OR  3!!' 
PAUSE 
go  to  1 
endif 
C 

TM-IM*KT 


271 


call  TCONST ( WMO , TM/F , TAU2 , NTIME , NTIM2 , DELTIM , WM1 ) 
call  INTGRL (NTIME , NTIM4 , DELTIM , THETAO , FVALA , WM1 , CVAL4 , TVAL4 , THET1 ) 
THETA=THET1 
C 

Q  ********************************************** 

C     ***  CONVERGENCE  CRITERIA  (Newton's  Method)  *** 
C     ********************************************** 

C 

if  (NTIME  .eq.  1)  then 
X3=WM1 
F2=0. 
go  to  150 
end  if 
C 

if  (NUMIT  .eq.  1)  then 
F2=(WM1-WM)*1.2 
X3=1.001*WMl+1.0E-4 
RELERR=abs(F2/X3) 
go  to  310 
end  if 
C 

F2=WM1-WM 

if  (Fl  .eq.  F2)  F2=. 999*F2-l.E-8 
if  (X2  .ne.  0.)  RELERR=abs(F2/X2) 
if  (X2  .eq.  0.)  RELERR-1. 
if  (RELERR  .gt.  l.E-8)  then 
X3-X2-F2*(X1-X2)/(F1-F2) 
endif 
310  X1-X2 
X2-X3 
F1=F2 
C 

WM=X2 
C 

if  (NUMIT  .ge.  10)  go  to  150 
if  (RELERR  .gt.  l.E-8)  go  to  200 
C 
c     ********************************* 

C     ***  END  INNER  SIMULATION  LOOP  *** 


C     ********************************* 
C 

150  call  DERIV(DELTIM, NTIME, NTIM3 , 0. ,XM1,WM1, XX, XDM1 ,XD,XDDM1,XDD , 
+  ALPHA) 

C 

X2-WM1+ALPHA*DELTIM 

PTHETA-THETA+WM1 *DELT IM 

THETAF- . 1*THETA*180 , /PI 

OMEGAF-. 1*WM1*180 . /PI 
C 
C   ...  Generate  Plotting  Arrays  . . . 

if  (TIME  .ge.  BEGTIM)  then 
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NCTR-NCTR+1 

if  ((mod(NCTR,SIM2PL)  .eq.  0)  .or.  CNCTR  .eq.  1))  then 
NPTS-NPTS+1 
X(NPTS)=TIME 
Y1(NPTS)=THETAF 
Y2(NPTS)=OMEGAF 
Y3(NPTS) -ORDER 
YA(NPTS)=IM 
end  if 
endif 
C 

100  CONTINUE 
C 

Q  ******************************** 

C      ***  END  MAIN  SIMULATION  LOOP  *** 
c      ******************************** 

C 

close (A, STATUS- 'KEEP*) 
C 
c     ****************************** 

C     *****  Plotting  selection  ***** 

Q  ****************************** 

c 

C  ***  Clear  Screen  &  Home  Cursor  *** 

A00  call  CLRSCR 
C 

write(*,1305) 
read(*,'(A)')  DISOPT 
C 

if  ((DISOPT  .eq.  'm' )  .or.  (DISOPT  .eq.  'M'))  then 
MODEL-99 
IOPORT-99 
elseif  ((DISOPT  .eq.  *p')  .or.  (DISOPT  .eq.  'P'))  then 
MODEL-PMODEL 
IOPORT-1 
C   ...  Ioport-9600  is  COM1  . . . 
C   ...  Ioport-9650  is  COM2  . . . 

if  ((MODEL  .eq.  20)  .or.  (MODEL  .eq.  30))  IOPORT-9600 
elseif  ((DISOPT  .eq.  *r')  .or.  (DISOPT  .eq.  *R'))  then 

GO  TO  13 
elseif  ((DISOPT  .eq.  's')  .or.  (DISOPT  .eq.  'S'))  then 
C 

Q  **************************************** 

C     ***  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  *** 

Q  **************************************** 

c 

open ( 7 , FILE- ' LM . INP ' , STATUS- ' NEW ' ) 
write (7, 1000)  PMODEL , PRTCHR 
write(7,1020)  BEGTIM,FINTIM,MAXITS,SIM2PL 
write(7,1022)  KPWM,KV,E0,EDOT0 
write(7,102A)  R,L, J,F,KT,KB,KP 
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write (7, 1026)  PERIOD , DBAND , XORG , YORG 
write (7, 1028)  KA.SYSORD 

write(7,1030)  TYPE , STPMAG.RSLOPE, SINAMP 
write(7,1032)  SINFRQ.SINPHA 
write(7,2000) 
close (7, STATUS- 'KEEP' ) 

go  to  400 

elseif  ((DISOPT  .eq.  'Q' )  .or.  (DISOPT  .eq.  'q'))  then 

GO  TO  460 
else 

go  to  400 
end  if 

410  call  CLRSCR 

if  ((DISOPT  .eq.  'p')  .or.  (DISOPT  .eq.  'P'))  then 

call  GOTOXY(20,20) 

write(*,*)  PRTCHR 

call  GOTOXYd.l) 
endif 

write(*,1300) 
read(*, '(A)')  PLOPT 

if  ((PLOPT  .eq.  'Q* )  .or.  (PLOPT  .eq.  'q'))  then 

go  to  400 
elseif  (PLOPT  .eq.  *1')  then 
XTITLE-'TIME  (seconds)' 
XLEN— 15 

YTITLE-'FIN  POSITION  (deg)' 
YLEN-19 
if  (ELEMNT  .eq.  1)  then 

PTITLE-'FIN  POSITION  RESPONSE  WITH  RELAY  CONTROLLER' 
'PLEN-44. 
elseif  (ELEMNT  .eq.  2)  then 

PTITLE-'FIN  POSITION  RESPONSE  WITH  SAT  AMP  CONTROLLER' 
PLEN-46. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-'FIN  POSITION  RESPONSE  WITH  PWM  CONTROLLER' 
PLEN-42. 
endif 

if  (SYSORD  .eq.  2)  then 

PTIT1-' REDUCED  ORDER  MODEL' 

PLEN1-20. 
else 

PTIT1-* THIRD  ORDER  MODEL* 

PLEN1-18. 
endif 

call  MGRAPH(X,Y1,Y3, XORG, YORG, DISOPT) 
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elseif  (PLOPT  .eq.  '2')  then 

XTITLE='TIME  (seconds)* 

XLEN— 15 

YTITLE='FIN  VELOCITY  (deg/sec)' 

YLEN=23 
if  (ELEMNT  .eq.  1)  then 

PTITLE='FIN  VELOCITY  RESPONSE  WITH  RELAY  CONTROLLER' 

PLEN-44. 
elseif  (ELEMNT  .eq.  2)  then 

PTITLE='FIN  VELOCITY  RESPONSE  WITH  SAT  AMP  CONTROLLER' 

PLEN-46. 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE«='FIN  VELOCITY  RESPONSE  WITH  PWM  CONTROLLER' 

PLEN-42. 
endif 

if  (SYSORD  .eq.  2)  then 

PTITl-'REDUCED  ORDER  MODEL* 

PLEN1-20 . 
else 

PTIT1-' THIRD  ORDER  MODEL' 

PLEN1-18. 
endif 

call  GRAPH(X,Y2,XORG,YORG,DISOPT) 

elseif  (PLOPT  .eq.  '3')  then 

XTITLE»'TIME  (seconds)' 

XLEN=-15 

YTITLE-' MOTOR  CURRENT  (amps)* 

YLEN=20 
if  (ELEMNT  .eq.  1)  then 

PTITLE-* MOTOR  CURRENT  RESPONSE  WITH  RELAY  CONTROLLER' 

PLEN-45. 
elseif  (ELEMNT  .eq.  2)  then 

PTITLE-* MOTOR  CURRENT  RESPONSE  WITH  SAT  AMP  CONTROLLER' 

PLEN-47 . 
elseif  (ELEMNT  .eq.  3)  then 

PTITLE-' MOTOR  CURRENT  RESPONSE  WITH  PWM  CONTROLLER* 

PLEN-A3. 
endif 

if  (SYSORD  .eq.  2)  then 

PTITl-'REDUCED  ORDER  MODEL' 

PLEN1-20 . 
else 

PTIT1-* THIRD  ORDER  MODEL' 

PLEN1-18. 
endif 
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call  GRAPH (X, Y4 ,XORG, YORG.DISOPT) 
C 

else 

go  to  410 
end  if 
C 

go  to  400 
460  continue 
C 

Q  ***************************** 

C      ***  I/O  FORMAT  STATEMENTS  *** 

Q  ***************************** 

C 

4  format( ////, 2 5X, 'LUMPED  PARAMETER  DC  MOTOR  SIMULATION',//, 
+  25X,'     LT  Vincent  S.  Rossitto.USN' , / , 

+  25X, '      Naval  Postgraduate  School',/, 

+  25X,'  March  1987' ,//////) 

C 

5   format(32X, '***  MAIN  MENU  ***',//, 

+       20X,*(H] >  HARDWARE  Configuration  Menu',/, 

+       20X,'[M] >  MOTOR  Parameter  Menu',/, 

+       20X,'[N] >  NON-LINEAR  Element  Selection  Menu',/, 

+       20X,*[O] >  OPTIONS  for  Simulation',/, 

+       20X,'[C] >  COMMAND  Input  Selection  Menu',/, 

+       20X,'[S] >  SAVE  All  Changes ',/ , 

+       20X,*[R] >  RUN  Simulation  Program',/, 

+       20X,'[Q] >  QUIT  the  Program',//, 

+        8X, 'ENTER  SELECTION >',\) 

C 

105     format (30X, '***  HARDWARE  MENU  ***',//, 

+       20X,*[P] >  PRINTER/ PLOTTER  configuration  change',/, 

+       20X,'[Q] >  QUIT  THIS  MENU' ,//, 

+        8X, 'ENTER  SELECTION >* , \ ) 

1000  format(lX,I3,2X,A50) 

1020  format(lx,3F15.7,lX,I3) 

1022  fonnat(lX,4F15.7) 

1024  formate IX, 7F8. 4) 

1026  format(LX,4F8.4) 

1028  format(lX,F12.7,lX,Il) 

1030  format(lX,A15,3F15.7) 

1032  format(lX,2F15.7) 

2000  format (IX, 'END  OF  FILE') 
C 

130   FORMAT ( 24X, ****  PRINTER  OPTIONS  MENU  ***',//, 

+   15X,'[0]  — >  Epson  FX-80  Printer,  single  density',/, 

+   15X,'[1]  -->  Epson  FX-80  Printer,  double  density',/, 

+   15X,'[2]  -->  Epson  FX-80  Printer,  dble  spd.dual  density',/, 

+   15X,'[3]  -->  Epson  FX-80  Printer,  quad  density',/, 

+   15X,'[4]  -->  Epson  FX-80  Printer,  CRT  Graphics  I',/, 

+   15X,'[5]  -->  Epson  FX-80  Printer,  plotter  graphics',/, 

+   15X,'[6]  -->  Epson  FX-80  Printer,  CRT  Graphics  11',/, 
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+   15X,'[10]  ->  Epson  FX-100  Printer,  single  density',/, 

+  15X,'[11]  ->  Epson  FX-100  Printer,  double  density',/, 

+   15X,'[12]  ->  Epson  FX-100  Printer,  dble  spd.dual  density',/, 

+   15X,'[13]  ->  Epson  FX-100  Printer,  quad  density',/, 

+   15X,'[14]  ->  Epson  FX-100  Printer,  CRT  Graphics  I',/, 

+   15X,'[15]  ->  Epson  FX-100  Printer,  plotter  graphics',/, 

+   15X,'"[16]  ->  Epson  FX-100  Printer,  CRT  Graphics  11',/, 

+   15X,'[20]  ->  HP  7470A  Graphics  Plotter',/, 

+   15X,'[30]  ->  HP  7475A  Graphics  Plotter',/, 

+   15X,'[60]  ->  HP  2686A  Laser  Jet  Printer  (NPS  installation)',/, 

+   15X,'[Q]  — >   QUIT  THIS  MENU' ,//, 

+   3X, 'Enter  Printer  Selection  Integer  or  Q  to  QUIT  >  *,\) 

C 
230   format (12X, '***  MOTOR  PARAMETER  SETTINGS  MENU  ***',//, 
+  AX,F12.7,1X, ' [KT]     Motor  Torque  Constant',/, 
+  4X.F12.7.1X, ' [KB]     Motor  Back  EMF  Constant',/, 
+  4X,F12,7,1X, ' [R]      Motor  Equivalent  Resistance  (ohms)',/, 
+  4X,F12.7,1X, * [L]      Motor  Inductance  (henries)',/, 
+  4X,F12.7,1X, ' [J]      Motor  Inertia  (oz-in/s~2) ' , / , 
+  4X,F12.7,1X,' [F]      Motor  Viscous  Friction  Coeff',/, 
+  4X,F12.7,1X, ' [KP]     Motor  Position  Feedback  Constant',/, 
+  4X,F12.7,1X, * [KV]     Motor  Velocity  Feedback  Constant',/, 
+  15X,I1,1X, ' [SYSORD]  System  Order  (2«Reduced; 3=Linearized) ' , / , 
+  17X,'[Q)      QUIT  THIS  MENU',//, 
+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 
240   format(12X, '***  SIMULATION  OPTIONS  MENU  ***',//, 

+  1X,F15.7,1X,' [BEGTIM]   Start  Time  of  Plotting  Window',/, 

+  1X,F15.7,1X,' [FINTIM]   Stop  Time  of  Plotting  Window',/, 

+  1X,F15.7,1X,'[MAXITS]   Max  Number  of  Simulation  Iterations',/, 

+  13X,I3,1X, ' [SIM2PL]   Ratio:  Points  Simulated/Plotted',/, 

+  1X,F15.7,1X,' [E0]      Initial  Fin  Position  (deg)*,/, 

+  1X,F15.7,1X, ' [EDOT0]   Initial  Fin  Velocity  (deg/s)',/, 

+  1X.F15.7.1X,' tXORG]   X  Coordinate  of  Plotting  Origin',/, 

+  1X,F15.7,1X,*[Y0RG]    Y  Coordinate  of  Plotting  Origin',/, 

+  17X,*[Q]       QUIT  THIS  MENU',///, 

+  1SX, 'Computed  simulation  step  size  >  ',F9.8,  'seconds',/, 

+  1SX, 'Computed  total  number  of  steps >  ' ,15,//, 

+  lX.'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  --->  ',\) 

C 
245   format(12X,****  COMMAND  INPUT  SELECTION  MENU  ***',//, 
+  1X,A15,1X,' [TYPE]     STEP,  RAMP,  or  SINE  Response',/, 
+  1X,F15.7,1X, * [STPMAG]   Commanded  Position  for  STEP  Response',/ 
+  1X,F15.7,1X,* [RSLOPE]   Slope  of  RAMP  Function',/, 
+  1X,F15.7,1X,* [SINAMP]   Amplitude  of  SINE  Function',/, 
+  1X,F15.7,1X,' [SINFRQ]   Frequency  (deg/sec)  of  SINE  Function',/ 
+  1X,F15.7,1X,*[SINPHA]   Phase  Angle  (deg)  of  SINE  Function',/, 
+  17X,'[Q]       QUIT  THIS  MENU',///, 
+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 
270   format(///,8X,****  NON-LINEAR  ELEMENT  SELECTION  ***',//, 
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+  10X,'[R]    Relay  (Bang-Bang)',/, 

+  lOX.'tP]     Pulse  Width  Modulator' ,/, 

+  10X,'[A]    Amplifier  (Saturating)',/, 

+  10X,'[Q]     QUIT  THIS  MENU/RETURN  TO  MAIN  MENU',//, 

+  IX, 'Enter  Selection  >  ',\) 

C 

272   formatd OX, 'CURRENT  SELECTION  — >  ',A30) 
C 
280   format(///,8X,'***  SATURATING  AMPLIFIER  SPECIFICATIONS  ***',//, 

+  1X.F15.7.1X, ' [DBAND]    Deadband  Applied  to  System  Feedback*,/, 

+  1X,F15.7,1X,' [KA]      Amplifier  Gain',/, 

+  17X,'[Q]       QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  — >  ',\) 
C 
290   fonnat(///,15X,'***  RELAY  SPECIFICATIONS  ***',//, 

+  1X,F15.7,1X, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 

+  17X,'[Q]        QUIT  THIS  MENU*,//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  >  ',\) 

C 
300   format(///,5X,'***  PULSE  WIDTH  MODULATOR  SPECIFICATIONS  ***',//, 

+  1X.F15.7, IX,' [DBAND]    Deadband  Applied  to  System  Feedback',/, 

+  1X,F15.7,1X,' [PERIOD]   Period  of  PWM  Reference  Cycle(sec) ' , / , 

+  1X,F15.7,1X,' [KPWM]     PWM  Amplifier  Gain' ,/, 

+  17X,'[Q]       QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  — >  *,\) 
C 

1200  format(20X, 'LINEAR  MODEL  OF  BRUSHLESS  DC  MOTOR',//, 

+  15X.I1.1X, ' [SYSORD]   System  Order  (2-Reduced; 3==Linearized) ' , / , 
+  1X,F15.7,1X,' [BEGTIM]   Start  Time  of  Plotting  Window',/, 
+  1X,F15.7,1X,' [FINTIM]   Stop  Time  of  Plotting  Window',/, 
+  1X,F15.7,1X,' [MAXITS]   Max  Number  of  Simulation  Iterations',/, 
+  13X.I3.1X,' [SIM2PL]   Ratio:  Points  Simulated/Plotted*,/, 
+  4X.F12.7.1X, ' [KT]      Motor  Torque  Constant',/, 
+  AX,F12.7,1X,'[KB]      Motor  Back  EMF  Constant',/, 
+  AX,F12,7,1X, * [R]       Motor  Equivalent  Resistance  (ohms)',/, 
+  4X.F12.7.1X, ' [L]       Motor  Inductance  (henries)',/, 
+  4X,F12,7,1X,' [J]       Motor  Inertia  (oz-in/s~2) ' , / , 
+  AX.F12.7.1X, ' [F]       Motor  Viscous  Friction  Coeff',/, 
+  AX.F12.7.1X, ' [KP]      Motor  Position  Feedback  Constant',/, 
+  AX.F12.7.1X, ' [KV]      Motor  Velocity  Feedback  Constant',/, 
+  AX.F12.7.1X, ' [KA]      Saturating  Amplifier  Gain  (if  used)*,/, 
+  4X, F12. 7, IX, ' [PERIOD]   Period  of  PWM  Reference  Cycle*,/, 
+  4X.F12.7, IX, ' [DBAND]    Position  Feedback  Deadband',/, 
+  1X,F15.7,1X,'[E0)      Initial  Fin  Position  (deg)*,/, 
+  1X,F15.7,1X,'[EDOTO]    Initial  Fin  Velocity  (deg/s)') 
C 

1201  format(lX,A15,lX,*[TYPE]     STEP,  RAMP,  or  SINE  Response',/, 

+  1X,F15.7,1X, ' [STPMAG]   Commanded  Position  for  STEP  Response',/, 

+  1X,F15,7,1X,*[RSL0PE]   Slope  of  RAMP  Function*,/, 

+  1X,F15.7,1X,*[SINAMP]   Amplitude  of  SINE  Function',/, 

+  1X,F15.7,1X, ' [SINFRQ]   Frequency  (deg/sec)  of  SINE  Function',/, 
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+  1X.F15.7.1X, ' [SINPHA]   Phase  Angle  (deg)  of  SINE  Function*) 
C 
1205  F0RMAT(1X,F8.6,1X,1P5E12.3) 

1300  F0RMAT(/////,2X, 'The  following  are  plotting  options',//, 
+  5X,'[1]  FIN  POSITION  response',/, 

+  5X,'[2]  FIN  VELOCITY  response',/, 

+  5X,'[3]  MOTOR  CURRENT  response',/, 

+  5X,'[Q]  QUIT  THIS  MENU',//, 

+  2X, 'Enter  selection  [1,Q]  >  *,\) 

C 
1305  FORMAT( /////, 2X, 'Display  options:',/, 
+  5X, * [M]  MONITOR' ,/, 

+  5X,'[P]  PRINTER',/, 

+  5X,'[R]  RETURN  TO  START-UP  MENU  (RE-INITIALIZE)',/, 

+  5X,'[S]  SAVE  SIMULATION  SPECIFICATIONS  TO  DISK',/, 

+  5X,'[Q)  QUIT  THE  PROGRAM',//, 

+  2X, 'Enter  selection  [1,2,3,Q]  — ->  *,\) 

C 

1500  format(lX,I3,2X,A50) 
C 

STOP 
END 

C  — 

c   ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
C  *****(single  function  plot)***** 
c  ******************************** 

Subroutine  GRAPH (X , Y , XORG , YORG .DISOPT) 
C 

implicit  REAL**  (A-Z) 

COMMON  BEGTIM ,  FINTIM ,  NPTS ,  IOPORT , MODEL , XLEN ,  YLEN ,  PLEN ,  PLEN1 , 
+       XTITLE,YTITLE,PTITLE,PTIT1 
real*4  X(IOIO) , YC1010) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , NCHAR , NCHAR1 
character* 1  DISOPT, ANS 
character*25  XTITLE.YTITLE 
character*51  PTITLE.PTIT1 
C 

C  ...  Make  a  new  title. . . 
5   call  CLRSCR 

if  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.  'p'))  then 
call  GOTOXY(8,30) 
write(*,*)  'Current  Title  is:' 
call  GOTOXY(10,20) 
write(*,*)  PTITLE 
call  GOTOXY(11,20) 
write(*,*)  PTIT1 
call  GOTOXY(15,25) 

write (*,* (A\)' )  'Do  you  want  to  change  the  title?  ' 
read(*,*(A)')  ANS 
call  CLRSCR 
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if  ((ANS  .eq.  'Y' )  .or.  (ANS  .eq.  'y'))  then 

call  GOTOXY(5,10) 
write(*,*)  'Enter  titles  in  left  justified  format' 

call  GOTOXY(12,10) 
write (*,*)  '12345678901234567890123456789012345678901234567890' 

call  GOTOXY(13,10) 
write(*,*)  '         12         3         4         5' 

call  GOTOXY(15,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXY(20,10) 
write (*,*)  '12345678901234567890123456789012345678901234567890' 

call  GOTOXY(21,10) 
writeC*,*)  '        12        3        4        5' 

call  GOTOXY(23,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXYdl.ll) 
read(*,'(A51)')  PTITLE 

call  GOTOXY(15,46) 
read(*,*)  PLEN 

call  GOTOXYU9,ll) 
read(*. '(A51)')  PTIT1 

call  GOTOXY(23,46) 
read(*r*)  PLEN1 
elseif  ((ANS  .eq.  'N')  .or.  (ANS  .eq.  'n'))  then 

go  to  10 
endif  % 

go  to  5 
endif 

10  call  GOTOXY(10,25) 

write(*,*)  'Calculating  Plotting  Data' 

AS PRAT-. 65 

CHARHT-.22 

CHARH1-.20 

PTX- . 5+ ( 6 . -PLEN*ASPRAT*CHARHT ) /2 . 

PTY-4 . 5 

PTX1= . 5+ ( 6 . tPLEN1*ASPRAT*CHARH1 ) /2 . 

PTYl=4 . 1 

NCHAR-i fix (PLEN) 

NCHARl-ifix(PLENl) 

call  PLOTS (0.IOPORT, MODEL) 
call  FACTOR(l.OO) 
call  ASPECT (ASPRAT) 
. . .  Draw  a  Border 

if  ((DISOPT  .eq.  *P')  .or.  (DISOPT  .eq.  'p'))  then 
call  PLOT(XORG,YORG,-13) 
call  PLOT(8.0,0.0,2) 
call  PLOT(8.0,6.0,2) 
call  PLOT(0.0,6.0,2) 
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call  PLOT(0.0,0.0,2) 
call  PLOT( 1.25,1. ,-13) 

elseif  ((DISOPT  .eq.  'M' )  .or.  (DISOPT  .eq.  'm*))  then 
call  PL0T(1.,1. ,-13) 

end  if 
C 
C   ...  This  scaling  applies  when  the  X  axis  represents  Time... 

XCNPTS+D-BEGTIM 

FIRSTX  =  XCNPTS+1) 

X(NPTS+2)«(X(NPTS)-X(NPTS+l))/6. 

DELTAX  =  X(NPTS+2) 
C 

call  SCALE (Y, 4. ,NPTS,1) 

FIRSTY  -  YCNPTS+1) 

DELTAY  =  YCNPTS+2) 

call  STAXIS(.15, .22, .12, .080,3) 

call  AXIS(0.0,0.0,XTITLE,XLEN,6. ,0. , FIRSTX, DEL TAX) 

call  STAXIS(.15,.22, .12, .080,2) 

call  AXIS(0. ,0. ,YTITLE,YLEN,4. , 90 ., FIRSTY, DELTAY) 

call  SYMBOL (PTX,PTY,CHARHT,PTITLE,0. ,NCHAR) 

call  SYMBOL (PTX1,PTY1,CHARH1,PTIT1, 0 . ,NCHAR1) 

call  LINE(X,Y,NPTS, 1,0,0) 

call  PLOT(0. ,0.,999) 
C 

MODEL-99 

IOPORT-99 
C 

return 

end 
C 

Q        ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
C  *****  (multi-function  plot)***** 
C   ******************************** 

Subroutine  MGRAPB(X,Y,Z,XORG,YORG, DISOPT) 
C 

implicit  REAL**  (A-Z) 

COMMON  BEGTIM , FINTIM , NPTS , IOPORT , MODEL , XLEN , YLEN , PLEN , PLEN1 , 
+       XTITLE,YTITLE,PTITLE,PTIT1 
real*4  X(1010) , Y(1010) ,Z(1010) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , NCHAR , NCBAR1 
character*l  DISOPT, ANS 
character*25  XTITLE.YTITLE 
character*51  PTITLE.PTIT1 
C 

C  ...  Make  a  new  title. . . 
5   call  CLRSCR 

if  ((DISOPT  .eq.  *P*)  .or.  (DISOPT  .eq.  'p'))  then 
call  GOTOXY(8,30) 
write(*,*)  'Current  Title  is:' 
call  GOTOXY(10,20) 
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write(*,*)  PTITLE 
call  GOTOXY(11,20) 
write(*,*)  PTIT1 
call  GOTOXY(15,25) 

write (*,' (A\)' )  'Do  you  want  to  change  the  title?  ' 
read(*,'(A)')  ANS 
call  CLRSCR 
if  ((ANS  .eq.  »Y* )  .or.  (ANS  ,eq.  'y'))  then 

call  GOTOXY(5,10) 
write(*,*)  'Enter  titles  in  left  justified  format' 

call  GOTOXY(12,10) 
write (*,*)  '123A567890123A567890123A567890123A567890123A567890' 

call  GOTOXYU3, 10) 
write(*,*)  '         12         3         4         5' 

call  GOT0XY(15,25) 
write(*,*)  '#  of  characters  -->' 

call  GOTOXY(20,10) 
write (*,*)  '123A567890123A567890123A567890123A567890123A567890' 

call  GOTOXY(21,10) 
write(*,*)  *         1         2         3         A         5' 

call  GOTOXY(23,25) 
write(*,*)  '#  of  characters  — >' 

call  GOTOXYUl.ll) 
read(*,'(A51)')  PTITLE 

call  GOTOXY(15,A6) 
read(*,*)  PLEN 

call  GOTOXY(19,H) 
read(*, '(A51)')  PTIT1 

call  GOTOXY(23,A6) 
read(*,*)  PLEN1 
elseif  ((ANS  .eq.  'N')  .or.  (ANS  .eq.  'n'))  then 

go  to  10 
endif 
go  to  S 
endif 

10  call  GOTOXY(10,25) 

write (*,*)  'Calculating  Plotting  Data' 

ASFRAT-.65 

CHARHT-.22 

CHARH1-.20 

PTX=0 . 5+(6. -PLEN*ASPRAT*CHARHT) /2. 

PTY-A . 5 

PTX1-0 . 5+( 6 . -PLEN1*ASPRAT*CHARH1 ) /2 . 

PTY1-A . 1 

NCHAR-i fix (PLEN) 

NCHARl-ifix(PLENl) 

call  PLOTS (0.IOPORT, MODEL) 
call  FACTOR (1.00) 
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call  ASPECT (ASPRAT) 
C  ...  Draw  a  Border 

if  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.  'p'))  then 
call  PLOT ( XORG , YORG , - 13 ) 
call  PLOT(8.0,0.0,2) 
call  PLOT(8.0,6.0,2) 
call  PLOT(0.0,6.0,2) 
call  PLOT(0.0,0.0,2) 
call  PLOT( 1.25,1. ,-13) 

elseif  ((DISOPT  .eq.  'M' )  .or.  (DISOPT  .eq.  'm'))  then 
call  PLOT(l.,l.,-13) 

endif 
C 
C 
C   ...  This  scaling  applies  when  the  X  axis  represents  Time. . 

X(NPTS+1)=BEGTIM 

FIRSTX  -  X(NPTS+1) 

X(NPTS+2)=(X(NPTS)-X(NPTS+l))/6. 

DELTAX  -  X(NPTS+2) 
C 

call  SCALE ( Y, 4. ,NPTS,1) 

call  SCALE(Z,4.,NPTS,1) 

if  (Z(NPTS+2)  .gt.  Y(NPTS+2))  then 
Y ( NPTS+2 ) «Z ( NPTS+2 ) 

else 

Z(NPTS+2)-Y(NPTS+2) 

endif 

FIRSTY  -  Y(NPTS+1) 

DELTAY  -  Y(NPTS+2) 
C 

call  STAXIS(.15,.22, .12, .080,3) 

call  AXIS(0.0,0.0,XTITLE,XLEN,6. ,0. , FIRSTX, DELTAX) 

call  STAXIS(.15, .22, .12, .080,2) 

call  AXIS (0. ,0. ,YTITLE,YLEN, 4. ,90. , FIRSTY, DELTAY) 

call  SYMBOL (PTX,PTY,CHARHT,PTITLE, 0. ,NCHAR) 

call  SYMBOL(PTX1,PTY1,CHARH1,PTIT1,0.,NCHAR1) 

call  LINE(X,Y,NPTS, 1,0,0) 

call  CURVE(X,Z,NPTS,-.l) 

call  PLOT(0. ,0.,999) 
C 

MODEL-99 

IOPORT-99 
C 

return 

end 
C 
C    **************************************** 

C    *****  PULSE  WIDTH  MODULATOR  MODULE  ***** 

Q      **************************************** 


c 


Subroutine  PWMOD( TIME, NUMIT.TSTART, PERIOD, TOGGLE, POSERR, 
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+    DBAND.VIN.VREF, THRESH, KPWM) 
C 

IMPLICIT  R£AL*4  (A-Z) 
INTEGER*2  NUMIT.DIR 
L0GICAL*2  WAITNG, TOGGLE 
C 

C  ...  Reset  the  saw-tooth  reference  signal  . . . 
if  (TIME  .ge.  TSTART+PERIOD)  then 
TSTART=TSTART+PERIOD 
TOGGLE" . true . 
endif 
C 

if  (POSERR  .gt.  (O.+DBAND))  then 
DIR-1 

ERROR=abs (KPWM* ( POSERR-DBAND ) ) 
elseif  (POSERR  .It.  (O.-DBAND))  then 
DIR— 1 

ERROR=abs (KPWM* (POSERR+DBAND) ) 
else 

ERROR-0 . 
endif 

call  LIMIT ( 0. ,1. .ERROR, ERROR) 
call  RAMP ( TIME, TSTART.NREF) 
VREF-NREF/ PERIOD 
THRESH-1 . -ERROR 
C 

C   ...  "WAITING"  is  a  logical  variable  indicating  whether  or  not  a  new 
C       pulse  may  be  generated  . . . 

if  (NUMIT  .eq.  1)  WAITNG-TOGGLE 
C 

if  (WAITNG)  then 

if  (VREF  .gt.  THRESH)  then 
if  (DIR  .eq.  1)  then 
VIN-150. 
TOGGLE-. false, 
elseif  (DIR  .eq.  -1)  then 
VIN— 150. 
TOGGLE-. false, 
endif 
elseif  (VREF  .It.  THRESH)  then 
VIN-0 . 

TOGGLE- . true . 
endif 
endif 
C 

return 
end 
C 

Q  ************************ 

C    *****  RELAY  MODULE  ***** 
C    ************************ 
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Subroutine  RELAY ( POSERR , DBAND , VIN ) 
C 

implicit  R£AL*4  (A-Z) 
C 

if  (POSERR  .gt.  DBAND)  then 

VIN-150. 
elseif  (POSERR  .It.  -DBAND)  then 

VIN— 150. 
elseif  (abs(POSERR)  .le.  DBAND)  then 

VIN-0. 
endif 
C 

return 
end 
C 

Q       *************************************** 

C    *****  SATURATING  AMPLIFIER  MODULE  ***** 
c    *************************************** 

C 

Subroutine  AMPLIF( POSERR, DBAND, KA, VIN) 
C 

implicit  REAL**  (A-Z) 
C 

if  (abs (POSERR)  .le.  DBAND)  then 

VIN-0 . 
elseif  (((POSERR-DBAND)*KA  .gt.  0.)  .and. 
+  ((POSERR-DBAND)*KA  .It.  1.))  then 

VIN-150 . *(POSERR-DBAND)*KA 
elseif  (((POSERR+DBAND)*KA  .It.  0.)  .and. 
+  (( POSERR+DBAND )*KA  .gt.  -1.))  then 

VIN-150. *( POSERR+DBAND )*KA 
elseif  ((POSERR-DBAND)*KA  .ge.  1.)  then 

VIN-150. 
elseif  (( POSERR+DBAND )*KA  .le.  -1.)  then 

VIN— 150. 
endif 
C 

return 
end 
C 
c    ************************************************* 

C    *****  Cutoff-Saturation  Limiting  Subroutine  ***** 
C    ************************************************* 

Subroutine  LIMIT (RSAT , RCUT , INPUT , OUT ) 
implicit  REAL**  (A-Z) 
if  (INPUT  .le.  RSAT)  then 

OUT-RSAT 
elseif  (INPUT  .ge.  RCUT)  then 

OUT-RCUT 
else 
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OUT-INPUT 
end  if 
C 

return 
end 
C    ************************************** 

C    *****  Function  Switch  Subroutine  ***** 

Q  ************************************** 

Subroutine  FCNSW(X1 ,X2,X3 ,X4 ,OUT) 
implicit  REAL*4  (A-Z) 
if  (XI  .It.  0.0)  then 

OUT-X2 
elseif  (XI  . eq.  0.0)  then 

OUT-X3 
else 

OUT-X4 
end  if 
C 

return 
end 
c    ************************************ 

C    *****  Step  function  Subroutine  ***** 
c    ************************************ 

Subroutine  STEP (TIME.TSTEP, OUT) 
implicit  REAL*4  (A-Z) 
if  (TIME  .ge.  TSTEP)  then 

OUT- 1.0 
else 

OUT-0 . 0 
end  if 


return 
end 
c    *************************** 

C    *****  Deadspace  Subroutine 
c    *************************** 


Subroutine  DEADSP( PI, P2, VSGDEL, VSGERR) 
implicit  REAL**  (A-Z) 
if  (VSGDEL  .gt.  P2)  then 

VSGERR-VSGDEL-P2 
elseif  (VSGDEL  .It.  PI)  then 

VSGERR-VSGDEL-P1 
else 

VSGERR-0 . 0 
end  if 
C 

return 
end 
c    *************************** 

C    *****  Ramp  Subroutine  ***** 
g    *************************** 
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Subroutine  RAMP (TIME, TRAMP, OUT) 
implicit  REAL*4  (A-Z) 
if  (TIME  .ge.  TRAMP)  then 

OUT=TIME-TRAMP 
else 

OUT-0 . 0 
end  if 
C 

return 
end 
c     ********************* 

C     ***  TIME  CONSTANT  *** 

Q  ********************* 

c 

Subroutine  TCONST ( YO , X , TAU , NTIME , NTIM , DELTIM , Y ) 

implicit  real*4  (A-Z) 

integer*2  NTIME, NTIM 

if  (NTIME  .ne.  NTIM)  Y0=Y 

DECAY«=exp( -DELTIM/ TAU) 

Y-Y0+(X-Y0)*( 1 . -DECAY) 

if  (NTIME  .eq.  1)  Y-YO 

NTIM-NTIME 
C 

return 
end 
c    ********************************************* 

C    *****  First  Order  Derivative  Subroutine  ***** 

Q  ********************************************* 

Subroutine  DERIV(DELTIM, NTIME, NTIM1, IC2,XMl,NOWVAL, XX, XDM1, 
+  XD,XDDM1,XDD, SLOPE) 

implicit  REAL*4  (A-Z) 
integer*2  NTIME, NTIM1 
C 

if  (NTIME  .eq.  NTIM1)  then 

XX-NOWVAL 
else 
XM1-XX 
XX-NOWVAL 
XDM1-XD 
XDDM1-XDD 
end  if 
C 

XD-(XX-XMl) /DELTIM 

if  (abs(XD)  .It.  l.E-8)  XD-0 . 

if  (NTIME  .eq.  1)  XD-IC2 

XDD-(XD-XDM1 ) /DELTIM 

if  (abs(XDD)  .It.  l.E-8)  XDD-0 . 0 


NTIM1-NTIME 
XPRED*XX+XD*DELTIM+XDD*(DELTIM**2)/2.0 
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if  (abs(XPRED)  .It.  l.E-8)  XPRED=0 . 0 
SL0PE=(XPRED-XM1 ) / ( 2 . 0*DELTIM) 
if  (abs(SLOPE)  .It.  l.E-8)  SLOPE=0 . 0 
C 

return 
end 
q  ********************************************** 

C    *****  Trapezoidal  Integration  Subroutine  ***** 

Q  ********************************************** 

Subroutine  INTGRL (NTIME , NTIM2 , DELTIM , IC3 , PREVAL , NOWVAL , 
+  CURVAL,OUTOLD,OUTNEW) 

implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM2 
C 

if  ((NTIME  .eq.  NTIM2)  .or.  (NTIME  .eq.  1))  then 

CURVAL=NOWVAL 
else 

PREVAL  -  CURVAL 
CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
end  if 

if  (NTIME  .eq.  1)  OUTOLD-IC3 
OUTNEW  -  OUTOLD+(CURVAL+PREVAL)*DELTIM/2. 
NTIM2-NTIME 
C 

return 
end 

Q  **************************************** 

C    *****  CLEAR  SCREEN  AND  HOME  CURSOR  ***** 


C 


subroutine  CLRSCR 

character*!  C1,C2,C3,C4 

integer*2  IC(4) 

equivalence  (CI , IC(1) ) , (C2, IC(2) ) , (C3,IC(3) ) , (C4,IC(4) ) 

data  IC/16#1B,16#5B,16#32,16#AA/ 
C 
C  ***  Write  Escape  Code  to  Display  *** 

write(*,l)  C1,C2,C3,C4 
1  fortnat(lX,4Al) 
C 

return 

end 
c    ***************************************** 

C    *****  Position  Cursor  by  Row, Column  ***** 
c    a**************************************** 


subroutine  GOTOXY( ROW, COLUMN) 
integer*2  IC(« ) , ROW , COLUMN , L 
character*l  C1,C2,C5,C8,LC(5) 
character*5  CBUFF 

equivalence  (CI, IC(1) ) , (C2, IC(2) ) , (C5, IC(3) ) , (C8, IC(A) ) , 
K  (CBUFF, LC(D) 
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data  IC/16#1B,16#5B,16#3B,16#66/ 
C 

L=10000+100*ROW+COLUMN 
C 
C  ***  Write  Escape  Codes  to  a  Character  Buffer  *** 

write(CBUFF,2)  L 

2  format(I5) 
C 

C  ***  Write  Escape  Codes  to  Display  *** 

write(*,3)  C1,C2,LC(2) ,LC(3) ,C5,LC(4) ,LC(5) ,C8 

3  f ormat ( IX , 8A1 , \ ) 
return 

end 
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APPENDIX  D 
PHASE  PLANE  ANALYSIS  PROGRAM 


SNOfloatcalls 

SNOdebug 

C 

C      

C     I  I 

C      I   ROSSITTO,  VS   THESIS    PROF  GERBA  03/25/87  | 

C      | PHASE_PLANE_DESIGN_MODEL | 

C 

C      This  program  computes  and  plots  the  characteristic  slope  markers 

C      for  the  reduced  order  Brushless  DC  Motor  model.   Motor  parameters 

C      are  provided  by  the  user.  Additionally,  the  Non-Linear  Element 

C      performance  is  plotted.  Step  and  Ramp  responses  may  be  analyzed. 

C      Plotting  density  is  selectable  (lOOOpts/plt  max). 

C 

IMPLICIT  REAL*A  (A-Z) 

COMMON  XTIME ,Y1, Y2.Y3.Y4 , BEGTIM , FINTIM , NPTS , IOPORT , MODEL , 
+       XLEN , YLEN , PLEN , PPLANE , XTITLE , YTITLE , PTITLE 

REAL**  X( 1010 ), Y( 1010 ), Yl( 1010 ), Y2( 1010 ),Y3( 1010 ),Y4( 1010), 
+       XTIME(IOIO) 

INTEGER*2  NTERMS , IOPORT , MODEL , XLEN , YLEN , NTIME , NUMIT , NTIM1 , 
+         NTIM2 , NTIM3 , NT IMA , DIR , PMODEL , NPTS , NCTR , PPLANE , PTSPL1 , 
+         SIM2PL,ECTR,EDCTR, NUMBER, NDIM,CTR,ELEMNT,PTSPLT, VCTR 

LOGICAL*2  WAITNG, TOGGLE 

CHARACTER* 1  DISOPT.PLOPT 

CHARACTER*6  ANSI ,ANS11 , ANS21.ANS27 , PRTSEL , NONLIN 

CHARACTER*25  XTITLE, YTITLE 

CHARACTER* 2 5  NLCHAR 

CHARACTER*51  PRTCHR, PTITLE 
C 
C   ...  Introductory  Page  (1  time  good  deal!) 

call  CLRSCR 

write(*,4) 

PAUSE 
c     *************************************** 

C     ***  OPEN/READ/CLOSE  INPUT  DATA  FILE  *** 
c     *************************************** 

C 


13   open(7,FILE-'PHPLANE.INP' , STATUS- *  OLD ' .ACCESS- 'SEQUENTIAL' ) 
read (7, 1000)  PMODEL , PRTCHR 
read( 7 , 1020 )  BEGTIM , FINTIM , MAXITS , SIM2PL 
read(7,1022)  KPWM,KV,E0 ,EDOT0 
read(7,1024)  R,L, J,F,KT,KB,KP 
read (7, 1026)  RSLOPE, PERIOD, DBAND 
read (7, 1028)  KA , PTSPLT , XORG , YORG , WFACT 
read (7, 1030)  EMIN,EMAX,EDMIN,EDMAX 
c los  e ( 7 , STATUS- ' KEEP ' ) 
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Q  ************************************ 

C     ***  DISPLAY  MAIN  MENU  SELECTIONS  *** 

Q  ************************************ 

c 

1   call  CLRSCR 

call  GOTOXY(8,l) 
write(*,5) 
read(*,'(A)')  ANSI 
C   ...  Hardware  Options  . . . 

if  ((ANSI  .eq.  'h')  .or.  (ANSI  .eq.  'H'))  then 
C 
101     call  CLRSCR 

call  GOTOXY(17,24) 

write (*,*)•***  CURRENT  PRINTER  SELECTION  ***' 
call  GOTOXY(20,20) 
write (*,*)  PRTCHR 
call  G0TOXY(10,l) 
write(*,105) 
read(*,'<A)' )  ANS11 
C 
C   ...  Printer  Options  . . . 

if  ((ANS11  .eq.  *p')  .or.  (ANS11  .eq.  'P'))  then 
131        call  CLRSCR 
write(*(130) 
read(*,'(A)')  PRTSEL 
C 

if  (PRTSEL  .eq.  '0')  then 

PRTCHR»' Epson  FX-80  Printer,  single  density' 
PMODEL-0 
elseif  (PRTSEL  .eq.  '1')  then 

PRTCHR- 'Epson  FX-80  Printer,  double  density' 
PMODEL-1 
elseif  (PRTSEL  .eq.  '2')  then 

PRTCHR= ' Epson  FX-80  Printer,  dble  spd.dual  density' 
PMODEL-2 
elseif  (PRTSEL  .eq.  '3')  then 

PRTCHR" ' Epson  FX-80  Printer,  quad  density' 
PMODEL-3 
elseif  (PRTSEL  .eq.  '4')  then 

PRTCHR=' Epson  FX-80  Printer,  CRT  Graphics  I' 
PMODEL-A 
elseif  (PRTSEL  .eq.  '5')  then 

PRTCHR=' Epson  FX-80  Printer,  plotter  graphics' 
PMODEL-5 
elseif  (PRTSEL  .eq.  '6')  then 

PRTCHR-'Epson  FX-80  Printer,  CRT  Graphics  II' 
PMODEL-6 
elseif  (PRTSEL  .eq.  '10')  then 

PRTCHR»'Epson  FX-100  Printer,  single  density' 


PMODEL-7 


elseif  (PRTSEL  .eq.  '11')  then 
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PRTCHR='Epson  FX-100  Printer,  double  density' 
PMODEL-11 
elseif  (FRTSEL  .eq.  '12')  then 

PRTCHR='Epson  FX-100  Printer,  dble  spd.dual  density' 
PMODEL«=12 
elseif  (PRTSEL  .eq.  '13')  then 

PRTCHR='Epson  FX-100  Printer,  quad  density' 
PMODEL=13 
elseif  (PRTSEL  .eq.  '14')  then 

PRTCHR='Epson  FX-100  Printer,  CRT  Graphics  I' 
PMODEL-U 
elseif  (PRTSEL  .eq.  '15')  then 

PRTCHR=' Epson  FX-100  Printer,  plotter  graphics' 
PMODEL=15 
elseif  (PRTSEL  .eq.  '16')  then 

PRTCHR='Epson  FX-100  Printer,  CRT  Graphics  II' 
PMODEL=16 
elseif  (FRTSEL  .eq.  '20')  then 

PRTCHR='HP  7470A  Graphics  Plotter' 
PMODEL-20 
elseif  (PRTSEL  .eq.  '30')  then 

PRTCHR-'HP  7475A  Graphics  Plotter' 
PMODEL=30 
elseif  (PRTSEL  .eq.  '60')  then 

PRTCHR='HP  2686A  Laser  Jet  Printer' 
PMODEL=60 
C 
C   ...  Quit  the  Printer  Menu  . . . 

elseif  ((PRTSEL  .eq.  'Q' )  .or.  (PRTSEL  .eq.  'q'))  then 

go  to  101 
else 

go  to  131 
endif 
go  to  101 
C 
C   ...  Quit  the  Hardware  Menu  . . . 

elseifUANSll  .eq.  'q')  .or.  (ANS11  .eq.  'Q'))  then 

go  to  1 
else 

go  to  101 
endif 
C 
C   ...  Motor  Parameters  . .  . 

elseif  ((ANSI  .eq.  'm' )  .or.  (ANSI  .eq.  'M'))  then 
C 
201     call  CLRSCR 

write(*,230)  KT,KB,R,L, J,F,KP,KV 
read(*, '(A)')  ANS21 
C 

if  (ANS21  .eq.  *KT' )  then 
call  GOTOXY(24,l) 
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write (*, * (A\)* ) 'Enter  a  REAL  value  for  KT— > 

read(*,*)  KT 

go  to  201 
elseif  (ANS21  .eq.  'KB')  then 

call  GOTOXY(24,l) 

write(*, ' (A\ ) ' )' Enter  a  REAL  value  for  KB--> 

read(*,*)  KB 

go  to  201 
elseif  (ANS21  .eq.  'R' )  then 

call  GOT0XY(24,l) 

write(*, ' (A\ )') 'Enter  a  REAL  value  for  R — >  ' 

read(*,*)  R 

go  to  201 
elseif  (ANS21  .eq.  'L')  then 

call  GOTOXY(24,l) 

write(*,  '  (A\)'  )  'Enter  a  REAL  value  for  L~>  ' 

read(*,*)  L 

go  to  201 
elseif  (ANS21  .eq.  'J')  then 

call  GOTOXY(24,l> 

write(*,  '  (A\  ) '  )  'Enter  a  REAL  value  for  J~>  * 

read(*(*)  J 

go  to  201 
elseif  (ANS21  .eq.  'F')  then 

call  G0T0XY(24,1) 

write(*. ' (A\)' ) 'Enter  a  REAL  value  for  F — >  ' 

read(*,*)  F 

go  to  201 
elseif  (ANS21  .eq.  'KP' )  then 

call  GOTOXY(24,l) 

write(*, *(A\)' ) 'Enter  a  REAL  value  for  KP— > 

read(*,*)  KP 

go  to  201 
elseif  (ANS21  .eq.  'KV' )  then 

call  G0T0XY(24,1) 

write(*,'(A\)') 'Enter  a  REAL  value  for  KV— > 

read(*,*)  KV 

go  to  201 
C   ...  Quit  Motor  Parameters  Menu  . . . 
elseif  (ANS21  .eq.  'Q')  then 

go  to  1 
else 

go  to  201 
end  if 
C 

C   ...  NON-LINEAR  ELEMENT  SELECTION  MENU  . . . 
C 

elseif  ((ANSI  .eq.  'n' )  .or.  (ANSI  .eq.  'N'))  then 
14    call  CLRSCR 

call  GOT0XY(21,l) 
write (*, 272)  NLCHAR 
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call  GOTOXYU.l) 
write(*,270) 
read(*. '(A)' )  ANS27 
. . .  RELAY  AS  NON-LINEAR  ELEMENT  . . . 

if  ((ANS27  .eq.  *r')  ,or.  (ANS27  .eq.  'R'))  then 

ELEMNT-1 

NLCHAR-' RELAY' 
291       call  CLRSCR 

NONLIN='R' 

write(*,290)  DBAND 

read(*, '  CA) '  )  ANS21 

if  (ANS21  .eq.  'DBAND')  then 
call  GOTOXY(24,l) 

writef*, ' (A\ )') 'Enter  a  REAL  value  for  DBAND — >  ' 
read(*,*)  DBAND 
go  to  291 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  291 
endif 
. . .  PULSE  WIDTH  MODULATOR  AS  NON-LINEAR  ELEMENT  . . . 

elseif  ((ANS27  .eq.  'p')  .or.  (ANS27  .eq.  'P'))  then 
ELEMNT-3 

NLCHAR-' PULSE  WIDTH  MODULATOR' 
301       call  CLRSCR 
NONLIN-'P' 

write (*, 300)  DBAND, PERIOD, KPWM 
read(*, '(A)')  ANS21 

if  (ANS21  .eq.  'DBAND')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  DBAND-->  ' 

read(*,*)  DBAND 

go  to  301 
elseif  (ANS21  .eq.  'PERIOD')  then 

call  GOTOXY(2A,l) 

write(*. ' (A\)' ) 'Enter  a  REAL  value  for  PERIOD-->  ' 

read(*,*)  PERIOD 

go  to  301 
elseif  (ANS21  .eq.  'KPWM')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  KPWM-->  ' 

read(*,*)  KPWM 

go  to  301 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  301 
endif 
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c 

C   ...  SATURATING  AMPLIFIER  AS  NON-LINEAR  ELEMENT  . . . 

elseif  ((ANS27  .eq.  'a')  .or.  (ANS27  .eq.  'A*))  then 
ELEMNT=2 

NLCHAR-* SATURATING  AMPLIFIER' 
281       call  CLRSCR 
NONLIN-'A' 

write(*,280)  DBAND, KA 
read(*,'(A)')  ANS21 
C 

if  (ANS21  .eq.  'DBAND' )  then 
call  GOTOXY(24,l) 

write(*, '(A\)' ) 'Enter  a  REAL  value  for  DBAND-->  ' 
read(*,*)  DBAND 
go  to  281 
elseif  (ANS21  .eq.  'KA' )  then 
call  GOTOXY(24,l) 

write(*, ' (A\ ) ' ) 'Enter  a  REAL  value  for  KA-->  ' 
read(*,*)  KA 
go  to  281 
elseif  ((ANS21  .eq.  'q')  .or.  (ANS21  .eq.  'Q'))  then 

go  to  14 
else 

go  to  281 
end  if 
C 

elseif  ((ANS27  .eq.  *n' )  .or.  (ANS27  .eq.  'N'))  then 

go  to  400 
elseif  ((ANS27  .eq.  *q')  .or.  (ANS27  .eq.  'Q'))  then 

go  to  1 
else 

go  to  14 
end  if 
C 
C   ...  Phase  Plane  Design  Menu  . . . 

elseif  ((ANSI  .eq.  *p*)  .or.  (ANSI  .eq.  'P'))  then 
C 
204     call  CLRSCR 

write (*, 260)  EMIN,EMAX,EDMIN,EDMAX 
read(*,'(A)')  ANS21 
C 

if  (ANS21  .eq.  'EMIN')  then 
call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  the  minimum  value  of  E — >  ' 
read(*,*)  EMIN 
go  to  204 
elseif  (ANS21  .eq.  'EMAX* )  then 
call  GOTOXY(24,l) 

write (*, ' (A\)' ) 'Enter  the  maximum  value  of  E — >  ' 
read(*,*)  EMAX 
go  to  204 
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elseif  (ANS21  .eq.  'EDMIN')  then 

call  GOTOXY(24,1) 

write(*, ' (A\ )') 'Enter  the  minimum  value  of  E  DOT--> 

read(*,*)  EDMIN 

go  to  204 
elseif  (ANS21  .eq.  'EDMAX' )  then 

call  GOTOXY(24,l) 

write(*, ' (A\ )') 'Enter  the  maximum  value  of  E  DOT — > 

read(*,*)  EDMAX 

go  to  204 
Quit  PHASE  PLANE  Dimensioning  Menu  . . . 

elseif  ((ANS21  .eq.  *q')  .or.  (ANS21  .eq.  'Q'))  then 


go  to  1 

else 

go  to  204 

end  if 

c 

c 

. .  Simulation  Opt 

c 


.or.  (ANSI  .eq.  '0' ))  then 

202     call  CLRSCR 

DELTIM- (FINTIM-BEGTIM)/(float( PTSPLT) *SIM2PL) 

if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS-IFIX(FINTIM/DELTIM)+1 

write(*,240)  BEGTIM, FINTIM, MAXITS, SIM2PL, PTSPLT, EO ,EDOT0 , 

RSLOPE , XORG , YORG , WFACT , DELTIM , NTERMS 
readf.*, *(A)')  ANS21 

if  (ANS21  .eq.  'BEGTIM')  then 

call  GOTOXY(24,1) 

write(*,'(A\)* ) 'Enter  a  REAL  value  for  BEGTIM— >  ' 

read(*,*)  BEGTIM 

go  to  202 
elseif  (ANS21  .eq.  'FINTIM*)  then 

call  GOTOXY(24,l) 

write (*, '(A\)' )' Enter  a  REAL  value  for  FINTIM— >  ' 

read(*,*)  FINTIM 

go  to  202 
elseif  (ANS21  .eq.  'MAXITS')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  MAXITS— >  ' 

read(*,*)  MAXITS 

go  to  202 
elseif  (ANS21  .eq.  'SIM2PL')  then 

call  GOTOXY(24,l) 

write(*, * (A\)' ) 'Enter  a  INTEGER  value  for  SIM2PL— >  ' 

read(*.*)  SIM2PL 

go  to  202 
elseif  (ANS21  .eq.  'PTSPLT')  then 
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call  G0T0XY(2A,1) 

write(*, ' (A\ ) ' ) 'Enter  a  INTEGER  value  for  PTSPLT-->  ' 

read(*,*)  PTSPL1 

if  (PTSPL1  .gt.  1000)  then 
PTSPLT=1000 

else 

PTSPLT-PTSPL1 

endif 

go  to  202 
elseif  (ANS21  .eg.  'E0')  then 

call  GOTOXY(24,l) 

write(*, ' (A\ )') 'Enter  a  REAL  value  for  E0  (degrees) — >  ' 

read(*,*)  E0 

go  to  202 
elseif  (ANS21  .eq.  'EDOT0')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  EDOT0  (deg/sec) — >  ' 

read(*,*)  EDOT0  , 

go  to  202 
elseif  (ANS21  .eq.  'RSLOPE* )  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' ) 'Enter  a  REAL  value  for  RSLOPE  (deg/sec) — > 

read(*,*)  RSLOPE 

go  to  202 
elseif  (ANS21  .eq.  'XORG' )  then 

call  GOTOXY(24,l) 

write(*,*(A\)') 'Enter  a  REAL  value  for  XORG— >  ' 

read(*r*)  XORG 

go  to  202 
elseif  (ANS21  .eq.  'YORG')  then 

call  GOTOXY(24,l) 

write(*, ' (A\)' )'Enter  a  REAL  value  for  YORG-->  * 

read(*,*)  YORG 

go  to  202 
elseif  (ANS21  .eq.  'WFACT')  then 

call  GOTOXY(24,l) 

write(*,'(A\)')'Enter  a  REAL  value  for  WFACT— >  ' 

read(*,*)  WFACT 

go  to  202 
Quit  Simulation  Options  Menu  . . . 
elseif  (ANS21  .eq.  'Q' )  then 

go  to  1 
else 

go  to  202 
end  if 
.  Save  Options  to  File  ... 
elseif  ((ANSI  .eq.  's')  .or.  (ANSI  .eq.  *S'))  then 

**************************************** 

***  OPEN /WRITE /CLOSE  INPUT  DATA  FILE  *** 
**************************************** 
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open(7,FILE='PBPLANE.INP' , STATUS- ' NEW' ) 
write (7. 1000)  PMODEL , PRTCHR 
write (7, 1020)  BEGTIM,FINTIM,MAXITS,SIM2PL 
write (7, 1022)  KPWM,KV,E0,EDOT0 
write(7,1024)  R,L, J,F,KT,KB,KP 
write (7, 1026)  RSLOPE , PERIOD , DBAND 
wr ite ( 7 , 1028 )  KA , PTSPLT , XORG , YORG , WFACT 
write (7, 1030)  EMIN,EMAX,EDMIN,EDMAX 
write(7,2000) 
close(7,STATUS«*KEEP' ) 
C 

go  to  1 
C 
C   ...  Run  the  Program  . . . 

elseif  ((ANSI  .eq.  'r')  .or.  (ANSI  .eq.  *R'))  then 
go  to  2 
C 
C   ...  Quit  the  Program  . . . 

elseif  ((ANSI  .eq.  'q')  .or.  (ANSI  .eq.  'Q*))  then 

stop 
else 

go  to  1 
endif 
C 
C   ...  Open  an  Output  Data  File  . . . 

2  open(4,file-'PHPLANE,OUT' , status-'NEW' ) 
C 

PI-3. 14159 
N-.l 
C 

C   ...  Initializations  . . . 
NCTR-0 
NPTS-0 
NTIM2-1 
NTIM3-0 
NTIM4-0 
PARG1-0 . 0 
PARG2-0 . 0 
PVAL4-0 . 
CARGl-0 . 0 
CARG2-0 . 0 
CVAL4-0 . 
TOT1-0 . 0 
TOT2-0 . 0 
TVAL 1-0.0 
TVAL2-0 . 0 
TVAL4-0 . 
XM1-0.0 
XX-0,0 
XDM1-0 . 0 
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XD=0.0 

XDDM1-0 . 0 

XDD=0 . 0 

Xl-0 . 0 

Fl-0.0 

F2»0 . & 

X3-0.0 

WM1=0.0 

WM=0.0 

IM-O. 

IMO=0 . 

TSTART-0 . 0 

THEDEG-0 . 0 

TOGGLE" . true . 

PPLANE=0 

NUMBER=0 

NDIM=20 
C 

C   ...  Preliminary  Relationships  ... 
C   ...  Initial  perturbation  of  THETA  for  stability  check.  (0  otherwise) 

EORAD— E0*PI  /  ( 180  .  *N ) 

EDOT0R=-EDOT0*PI / ( 180 . *N ) 

if  (KP  .ne.  0.)  WM0-EDOT0R/KP 

X2-WM0 

if  (KP  .ne.  0.)  THETA0-E0RAD/KP 

PTHETA=THETA0 

TAU1-L/R 

TAU2-J/F 
C 

call  CLRSCR 
C  ...  Display  the  simulation  header  . . . 

call  CLRSCR 

call  GOTOXY(10,29) 

write (*,*)  'Simulation  in  Progress' 

DELTIM-(FINTIM-BEGTIM)/ (float (PTSPLT)*SIM2PL) 

if  (FINTIM/DELTIM  .gt.  MAXITS)  DELTIM  -FINTIM/MAXITS 

NTERMS-IFIX(FINTIM/DELTIM)+1 
C   ...  Output  Simulation  Options  to  Output  Data  File  . . . 

write(4,1200)  BEGTIM, FINTIM, MAXITS, SIM2PL, DELTIM, KT, KB, R,L, J, F, 
+  KP,KV,KPWM,KA,RSLOPE 

write (4, 1201)  PERIOD, DBAND, E0 ,EDOT0 
C 

call  GOTOXY(U,l) 

write(*,15)  DELTIM , NTERMS 
15   format (16X, 'Simulation  Step  Size  — >  '.F9.8,'  seconds',/, 
+       17X, 'Total  Number  of  Steps-->  ',16) 

call  GOTOXY(21,l) 
C 

if  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R'))  then 
write (*,*)  '  ***  NON-LINEAR  ELEMENT  IS  RELAY  ***' 

elseif  ((NONLIN  .eq.  'a')  .or.  (NONLIN  .eq.  'A'))  then 
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write (*,*)  '  ***  NON-LINEAR  ELEMENT  IS  SATURATING  AMPLI 

+FIER  **** 
elseif  ((NONLIN  .eq.  'p')  .or.  (NONLIN  .eq.  'P'))  then 
write(*,*)  '  ***  NON-LINEAR  ELEMENT  IS  PWM  ***' 

else 
write (*,*)  '  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  '  ...  Return  to  Main  Menu  ...' 

PAUSE 
go  to  1 
endif 
C 

SPACE=DELTIM/2.0 
C 

Q  ********************************** 

C      ***  START  MAIN  SIMULATION  LOOP  *** 
C     ********************************** 

c 

DO  100  NTIME=1,NTERMS 

TIME= (NTIME- 1 ) *DELTIM 

NUMIT-0 

THETA=PTHETA 
C 
C     *********************************** 

C     ***  START  INNER  SIMULATION  LOOP  *** 

Q  *********************************** 

c 

200    NUMIT-NUMIT+1 
WM-X2 
C 

THETAF- . 1*THETA*180 . /PI 
OMEGAF- . 1*WM*180 . /PI 
ORDER-RSLOPE*TIME 
POSERR-ORDER-KP*THETAF-KV*OMEGAF 
C 

C   ...  Utilization  of  Non-Linear  Element  . . . 
C   ...  PULSE  WIDTH  MODULATOR  . . . 

if  ((NONLIN  .eq.  *p')  .or.  (NONLIN  .eq.  'P'))  then 
call  PWMOD(TIME , NUMIT , TSTART , PERIOD , TOGGLE , POSERR, 
+  DBAND , AGCSAT , AGCCUT , ERRSAT , ERRCUT , VIN , VREF , THRESH , 

+  KPWM) 

C   ...  IDEAL  RELAY  . . . 

elseif  ((NONLIN  .eq.  'r')  .or.  (NONLIN  .eq.  'R*))  then 
call  RELAY (POSERR, DBAND, VIN) 
C   ...  SATURATING  AMPLIFIER  . . . 

elseif  ((NONLIN  .eq.  'a')  .or.  (NONLIN  .eq.  'A*))  then 

call  AMPLIF( POSERR, DBAND, KA, VIN) 
else 

call  GOTOXY(21,l) 

write(*,*)  '  ***  NON-LINEAR  ELEMENT  NOT  SELECTED  ***' 

write(*,*)  '  ...  Return  to  Main  Menu  ...' 

PAUSE 
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go  to  1 
endif 

C 

EN=VIN-WM*KB 
C 

C   ...Electrical  Time  Constant  due  to  Inductance  Neglected  ... 
C >  call  TCONST(IM0,EN/R,TAUl, NTIME, NTIM1.DELTIM.IM) 

IM=EN/R 

TM=IM*KT 

call  TCONST(WM0,TM/F,TAU2, NTIME, NTIM2,DELTIM,WM1) 
call  INTGRL( NTIME , NTIM4  ,  DELTIM, THETAO  ,  FVAL4 , WM1 ,CVAL4  ,  TVAL4  ,  THET1 ) 
THETA=THET1 
C 

Q  ********************************************** 

C     ***  CONVERGENCE  CRITERIA  (Newton's  Method)  *** 

Q  ********************************************** 

c 

if  (NTIME  .eq.  1)  then 
X3=WM1 
F2=0. 
go  to  150 
end  if 
C 

if  (NUMIT  .eq.  1)  then 
F2-(WM1-WM)*1.2 
X3=1.001*WMl+1.0E-4 
RELERR-abs(F2/X3) 
go  to  310 
end  if 
C 

F2-WM1-WM 

if  (Fl  .eq.  F2)  F2«. 999*F2-l.E-8 
if  (X2  .ne.  0.)  RELERR«abs(F2/X2) 
if  (X2  .eq.  0.)  RELERR-1. 
if  (RELERR  .gt.  l.E-8)  then 
X3-X2-F2*(X1-X2)/(F1-F2) 
endif 
310  X1-X2 
X2-X3 
F1-F2 
C 

WM=X2 
C 

if  (NUMIT  .ge.  10)  go  to  150 
if  (RELERR  .gt.  l.E-8)  go  to  200 
C 
C     ********************************* 

C     ***  END  INNER  SIMULATION  LOOP  *** 
C     ********************************* 

c 

150  call  DERIV(DELTIM, NTIME, NTIM3, 0. .XMl.WMl, XX, XDM1 ,XD,XDDM1,XDD, 
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+  ALPHA) 

C 

X2=WM1+ALPHA*DELTIM 
PTHETA=THETA+WM1*DELTIM 
THETAF= . 1*THETA*180 . /PI 
OMEGAF=, 1*WM1*180 . /PI 
DIRLOG=VIN/150. 

if  (ELEMNT  .eq.  1)  THRESH-POSERR 
if  (ELEMNT  .eq.  2)  THR£SH=POSERR 
if  (ELEMNT  .ne.  3)  VREF-0 . 
C 

C   ...  Generate  Plotting  Arrays  . . . 
if  (TIME  .ge.  BEGTIM)  then 
NCTR=NCTR+1 

if  ((mod(NCTR,SIM2PL)  .eq.  0)  .or.  (NCTR  .eq.  1))  then 
NPTS=NPTS+1 

X ( NPTS ) =ORDER-KP*THETAF 
Y ( NPTS ) "RSLOPE -KP*OMEGAF 
XTIME(NPTS)«TIME 
Y1(NPTS)-P0SERR 
Y2(NPTS)«VREF 
Y3 (NPTS) -THRESH 
Y4(NPTS)=DIRLOG 
endif 
endif 
C 

100  CONTINUE 
C 
C     ******************************** 

C     ***  END  MAIN  SIMULATION  LOOP  *** 
C     ******************************** 

C 


close(4,status='KEEP' ) 
C 
c     ****************************** 

C     *****  Plotting  selection  ***** 
c     ****************************** 

C 

C  ***  Clear  Screen  &  Home  Cursor  *** 

400  call  CLRSCR 
C 

write(*,1305) 
read(*,'(A)' )  DISOPT 
C 

if  ((DISOPT  .eq.  'm' )  .or.  (DISOPT  .eq.  *M'))  then 
MODEL-99 
IOPORT-99 
elseif  ((DISOPT  .eq.  "p')  .or.  (DISOPT  .eq.  'P'))  then 
MODEL-PMODEL 
IOPORT-1 
C   ...  Ioport-9650  is  COM2  . . . 
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if  ((MODEL  .eq.  20)  .or.  (MODEL  .eq.  30))  IOPORT=9650 
elseif  ((DISOPT  .eq.  'r')  .or.  (DISOPT  .eq.  'R'))  then 

GO  TO  13 
elseif  ((DISOPT  .eq.  's')  .or.  (DISOPT  .eq.  'S'))  then 
C 

Q  **************************************** 

C     ***  OPEN/WRITE/CLOSE  INPUT  DATA  FILE  *** 

Q  **************************************** 


c 


open(7 , FILE=' PHPLANE . INP' , STATUS='NEW' ) 

write (7, 1000)  PMODEL , PRTCHR 

wr ite ( 7 , 1020 )  BEGTIM , FINTIM, MAXITS , SIM2PL 

write(7,1022)  KPWM,KV,E0 ,EDOT0 

write (7, 1024)  R,L, J,F,KT,KB,KP 

write (7, 1026)  RSLOPE , PERIOD , DBAND 

write (7, 1028)  KA.PTSPLT.XORG, YORG.WFACT 

write (7, 1030)  EMIN , EMAX , EDMIN , EDMAX 

write(7,2000) 

close(7,STATUS-'KEEP' ) 

go  to  400 

elseif  ((DISOPT  .eq.  'w')  .or.  (DISOPT  .eq..  'W'))  then 
:   ...  Printer  ready??  ... 

call  CLRSCR 

call  GOTOXY(12,25) 

write (*,*)  'Please  ensure  PRINTER  is  ready' 

call  GOTOXY(20.1) 

PAUSE 
:   ...  Output  Simulation  Options  to  Printer  . . . 

open ( 8 , f i le« ' prn ' , status" ' new ' ) 

write(8,1200)  BEGTIM, FINTIM, MAXITS, SIM2PL.DELTIM, 
+  KT,KB,R,L,J,F(KP,KV(KPWM,KA,RSLOPE 

write (8, 1201)  PERIOD, DBAND, E0.EDOT0 
write(8,1202) 
1202  formate  1'  ) 

close (8, status" 'KEEP' ) 
go  to  400 

elseif  ((DISOPT  .eq.  'Q')  .or.  (DISOPT  .eq.  'q'))  then 

GO  TO  460 
else 

go  to  400 
end  if 

410  call  CLRSCR 

if  ((DISOPT  .eq.  'p')  .or.  (DISOPT  .eq.  *P'))  then 
call  GOTOXY(20,20) 
write(*,*)  PRTCHR 
call  GOTOXYd.l) 
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endif 

write(*,1300) 
read(*, ' (A) ' )  PLOPT 
C 

if  ((PLOPT  .eq.  *Q' )  .or.  (PLOPT  .eq.  'q'))  then 

go  to  400 
elseif  (PLOPT  .eq.  '1')  then 
if  (ELEMNT  .eq.  2)  KAPWM=KA 
if  (ELEMNT  .eq.  3)  KAPWM-KPWM 
C 

call  PGRAPH (X , Y , NPTS , EMIN , EMAX , EDMIN , EDMAX , DBAND , KT , KP , 
+      KV, KB, F,R, J, ANS27 , IOPORT , MODEL, KAPWM, ELEMNT, RSLOPE. 
+      XORG , YORG , WFACT , PERIOD , DISOPT , BEGTIM, FINTIM) 
elseif  (PLOPT  .eq.  '2')  then 
if  (ELEMNT  .eq.  2)  KAPWM=KA 
if  (ELEMNT  .eq.  3)  KAPWM=KPWM 
XTITLE=*TIME  (sec)' 
XLEN—10 

if  (ELEMNT  .eq.  3)  then 
YTITLE-*PWM  RESPONSE' 
YLEN-12 
elseif  (ELEMNT  .eq.  1)  then 
YTITLE-' RELAY  RESPONSE' 
YLEN-15 
elseif  (ELEMNT  .eq.  2)  then 
YTITLE=' AMPLIFIER  RESPONSE' 
YLEN-19 
endif 
C 

if  ((DISOPT  .eq.  'M* )  .or.  (DISOPT  .eq.  'm'))  then 

call  M1GRAPH( ELEMNT) 
elseif  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.  'p'))  then 

call  MGRAPH( DISOPT, KAPWM, DBAND, XORG, YORG, WFACT, ELEMNT) 
endif 
else 

go  to  410 
endif 
C 

go  to  400 
4  60  continue 
C 
C      ***************************** 

C      ***  I/O  FORMAT  STATEMENTS  *** 
c      ***************************** 

C 


4  format(////,24X, 'REDUCED  ORDER  MODEL  PHASE  PLANE  DESIGN',/, 
+  24X,*     LT  Vincent  S.  Rossitto,  USN',/, 

+  24X,'      Naval  Postgraduate  School',//, 

+  24X,'  March  1987' ,//////) 

5   format(32X, '***  MAIN  MENU  ****,//, 
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+       20X,'[H] >  HARDWARE  Configuration  Menu',/, 

+       20X,'[M] >  MOTOR  Parameter  Menu',/, 

+       20X,'[N] >  NON-LINEAR  Element  Selection  Menu',/, 

+       20X,'[P] >  PHASE  PLANE  Dimensioning  Menu',/, 

+       20X,'[O] >  OPTIONS  for  Simulation',/, 

+       20X,'[S] >  SAVE  All  Changes ',/ , 

+       20X,'[R] >  RUN  Simulation  Program',/, 

+       20X,'[Q] >  QUIT  the  Program',//, 

+        8X, 'ENTER  SELECTION >',\) 

105     format(30X, ****  HARDWARE  MENU  ***',//, 

+       20X,'[P] >  PRINTER/ PLOTTER  configuration  change',/, 

+       20X,'[Q] >  QUIT  THIS  MENU' ,//, 

+         8X, 'ENTER  SELECTION >',\) 

1000  format(lX,I3,2X,A50) 

1020  format ( Ix , 2F12 . 7 , F12 . 3 , IX , 13 ) 

1022  format(lX,4F15.7) 

1024  format(lX,7F8.4) 

1026  formate IX, 3F15. 7) 

1028  format(lX,F12.7,I5,lX,3F12.7) 

1030  format(lX,4F12.4) 

2000  format (IX, 'END  OF  FILE') 
C 

130   FORMAT (24X,****  PRINTER  OPTIONS  MENU  ***',//, 

+   15X,'[0]  — >  Epson  FX-80  Printer,  single  density',/, 

+   15X,'[1]  -->  Epson  FX-80  Printer,  double  density',/, 

+   15X,'[2]  -->  Epson  FX-80  Printer,  dble  spd.dual  density',/, 

+   15X,'[3]  -->  Epson  FX-80  Printer,  quad  density*,/, 

+  15X,'[4]  -->  Epson  FX-80  Printer,  CRT  Graphics  I*,/, 

+   15X,'[5]  -->  Epson  FX-80  Printer,  plotter  graphics',/, 

+   15X,'[6]  — >  Epson  FX-80  Printer,  CRT  Graphics  11',/, 

+   15X,'[10)  ->  Epson  FX-100  Printer,  single  density',/, 

+  15X,'[11]  ->  Epson  FX-100  Printer,  double  density',/, 

+  15X,'[12]  ->  Epson  FX-100  Printer,  dble  spd.dual  density',/, 

+   15X,*[13]  ->  Epson  FX-100  Printer,  quad  density',/, 

+   15X,'[1A]  ->  Epson  FX-100  Printer,  CRT  Graphics  I',/, 

+   15X,'[15]  ->  Epson  FX-100  Printer,  plotter  graphics',/, 

+   15X,'[16]  ->  Epson  FX-100  Printer,  CRT  Graphics  11',/, 

+   15X,*[20]  ->  HP  7470A  Graphics  Plotter',/, 

+   15X,*[30]  ->  HP  7475A  Graphics  Plotter',/, 

+   15X,'[60]  ->  HP  2686A  Laser  Jet  Printer  (NPS  installation)', 

+   15X,'[Q]  — >   QUIT  THIS  MENU' ,//, 

+   3X, 'Enter  Printer  Selection  Integer  or  Q  to  QUIT  >  ',\) 

C 

230   format( 12X, ****  MOTOR  PARAMETER  SETTINGS  MENU  ***',//, 
+  4X,F12.7,1X,'[KT]     Motor  Torque  Constant',/, 
+  4X.F12.7.1X,' [KB]     Motor  Back  EMF  Constant*,/, 
+  4X,F12.7,1X,' [R]      Motor  Equivalent  Resistance  (ohms)',/, 
+  4X.F12.7.1X, ' [L]      Motor  Inductance  (henries)',/, 
+  4X.F12.7.1X,' [J]      Motor  Inertia  (oz-in/s~2) ' , / , 
+  4X,F12.7,1X,*[F]      Motor  Viscous  Friction  Coeff',/, 
+  4X.F12.7.1X,' [KP]     Motor  Position  Feedback  Constant*,/, 


305 


+  4X.F12.7.1X, ' [KV]     Motor  Velocity  Feedback  Constant',/, 

+  17X,'[Q]      QUIT  THIS  MEKU',//, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 
240   format (12X, ' ***  SIMULATION  OPTIONS  MENU  ***',//, 

+  1X,F15.7,1X,' [BEGTIM]   Start  Time  of  Plotting  Window',/, 

+  1X,F15.7,1X, ' [FINTIM]   Stop  Time  of  Plotting  Window',/, 

+  1X.F15.4.1X, ' [MAXITS]   Max  Number  of  Simulation  Iterations',/, 

+  13X,I3,1X, ' [SIM2PL]   Ratio:  Points  Simulated/Points  Plotted',/, 

+  12X,IA,1X, ' [PTSPLT]   #  of  Points  per  Curve  per  Plot(lOOOmax) * , / , 

+  1X,F15.7,1X, ' [E0]      Initial  E  Perturbation  Offset  (deg)',/, 

+  1X.F15.7.1X, ' [EDOT0]   Initial  EDOT  Perturbation  Of fset(deg/s) ' , / , 

+  1X,F15.7,1X, ' [RSLOPE]  Ramp  Slope  (0  for  Step;  (  +  )  for  Ramp)',/, 

+  1X,F15.7,1X, ' [XORG]    X  Coordinate  of  Reference  Origin',/, 

+  1X,F15.7,1X, ' [YORG]    Y  Coordinate  of  Reference  Origin',/, 

+  1X,F15.7,1X, ' [WFACT]   Plotting  Scaling  Factor  (0.75  nominal)',/, 

+  17X,'[Q]        QUIT  THIS  MENU',///, 

+  1SX, 'Computed  simulation  step  size  >  ',F9.8,  'seconds',/, 

+  15X, 'Computed  total  number  of  steps >  ',16,//, 

+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 
260   format(/// ,16X,'***  PHASE  PLANE  DIMENSIONING  MENU  ***',//, 
+  1X,F15.7,1X, ' [EMIN]    Minimum  E  to  be  Plotted  on  Grid',/, 
+  1X.F15.7.1X, ' [EMAX]    Maximum  E  to  be  Plotted  on  Grid',/, 
+  1X,F15.7,1X,' [EDMIN]    Minimum  E  DOT  to  be  Plotted  on  Grid',/, 
+  1X.F15.7.1X,' [EDMAX]    Maximum  E  DOT  to  be  Plotted  on  Grid*,/, 
+  17X,*tQ]        QUIT  THIS  MENU*,//, 
+  IX, 'Enter  variable  name  (UPPERCASE)  or  Q  to  QUIT  >  ',\) 

C 
270   format (///, 8X, '***  NON-LINEAR  ELEMENT  SELECTION  ***',//, 
+  10X,'[R]    Relay  (Bang-Bang)',/, 
+  10X,'[P]     Pulse  Width  Modulator',/, 
+  10X,'tA]    Amplifier  (Saturating)',/, 

+  10X,'[N]     No  Trajectory  Calculation/  Only  Phase  PLANE  Map',/, 
+  10X,'[Q]    QUIT  THIS  MENU/RETURN  TO  MAIN  MENU*,//, 
+  IX, 'Enter  Selection  >  *,\) 

C 
272   formatdOX, 'CURRENT  SELECTION  — >  \A30) 

C 
280   format(///,8X, '***  SATURATING  AMPLIFIER  SPECIFICATIONS  ***',//, 
+  1X,F15.7,1X, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 
+  1X,F15.7,1X,'[KA]      Amplifier  Gain' ,/, 
+  17X,'[Q]        QUIT  THIS  MENU',//, 
+  IX, 'Enter  the  selection  (UPPERCASE)  >  *,\) 

C 
290   format(///,15X,'***  RELAY  SPECIFICATIONS  ***',//, 

+  1X.F15.7, IX, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 

+  17X,'[Q]        QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  >  *,\) 

C 
300   format(///,5X,'***  PULSE  WIDTH  MODULATOR  SPECIFICATIONS  ***',//, 
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+  1X.F15.7, IX, ' [DBAND]    Deadband  Applied  to  System  Feedback',/, 
•  +  IX, F15. 7,1X, ' [PERIOD]   Period  of  PWM  Reference  Cycle(sec)  * , / , 
+  1X,F15.7,1X,' [KPWM]    PWM  Amplifier  Gain' ,/, 
+  17X,'[Q]       QUIT  THIS  MENU',//, 

+  IX, 'Enter  the  selection  (UPPERCASE)  >  ',\) 

C 

1200  fonnat(20X, 'LINEAR  MODEL  OF  BRUSHLESS  DC  MOTOR',//, 

+  1X,F15.7,1X,' [BEGTIM]   Start  Time  of  Plotting  Window',/, 

+  1X,F15.7,1X, ' [FINTIM]   Stop  Time  of  Plotting  Window',/, 

+  1X,F15.4,1X, ' [MAXITS]   Max  Number  of  Simulation  Iterations',/, 

+  13X,I3,1X, ' [SIM2PL]   Ratio:  Points  Simulated/Plotted',/, 

+  1X.F15.9.1X, ' [DELTIM]   Simulation  Step  Size',/, 

+  1X,F15.7,1X, ' [KT]      Motor  Torque  Constant',/, 

+  1X.F15.7.1X, * [KB]      Motor  Back  EMF  Constant',/, 

+  1X.F15.7, IX, ' [R]       Motor  Equivalent  Resistance  (ohms)',/, 

+  1X,F15.7,1X, ' [L]       Motor  Inductance  (henries)*,/, 

+  1X.F15.7.1X, ' [J]       Motor  Inertia  (oz-in/s~2) ' , / , 

+  1X.F15.7.1X, ' [F]       Motor  Viscous  Friction  Coeff',/, 

+  1X,'F15.7,1X,  '  [KP]      Motor  Position  Feedback  Constant',/, 

+  1X,F15.7,1X( ' [KV]      Motor  Velocity  Feedback  Constant',/, 

+  IX, F15. 7, IX,* [KPWM]    PWM  Amplifier  Gain',/, 

+  1X.F15.7.1X, ' [KA]      Saturating  Amplifier  Gain  (if  used)',/, 

+  1X,F15.7,1X,* [RSLOPE]   Ramp  Slope  (0  for  Step;  (+)  for  Ramp)') 

1201  format(lX, F15. 7, IX. ' [PERIOD]   Period  of  PWM  Reference  Cycle',/, 
+  1X,F15.7,1X,* [DBAND]    Position  Feedback  Deadband',/, 

+  1X,F15.7,1X,*[E0]      Initial  E  Perturbation  Offset  (deg)',/, 
+  1X,F15.7,1X,* [EDOT0]    Initial  EDOT  Perturbation  Offset  (deg/s)') 
C 
1205  F0RMAT(1X,F8.6,1X,1P5E12.3) 

1300  FORMAT(/////,2X, 'The  following  are  plotting  options',//, 
+  5X,*[1]  PHASE  PLANE  Trajectory*,/, 

+  5X,'[2]  NON-LINEAR  Element  Performance  (PRINT  only)',/, 

+  5X,*[Q]  QUIT  THIS  MENU',//, 

+  2X, 'Enter  selection  [1,2,Q]  — >  *,\) 

C 
1305  FORMAT(/////,2X, 'Display  options:*,/, 
+  5X,' [M]  MONITOR',/, 

+  5X,'[P]  PRINTER',/, 

+  5X,'[R]  RETURN  TO  START-UP  MENU  (RE- INITIALIZE) ' , / , 

+  5X,'[S]  SAVE  SIMULATION  SPECIFICATIONS  TO  DISK',/, 

+  5X,*[W]  WRITE  SIMULATION  SPECIFICATIONS  TO  PRINTER',/, 

+  5X,'[Q]  QUIT  THE  PROGRAM',//, 

+  2X, 'Enter  selection  [M,P,R,S,W,Q]  — >  *,\) 

C 

1500  format(lX,I3,2X,A50) 
C 

STOP 
END 
c 

Q        ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
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C  *****(  phase-  plane   plot)***** 
q     ******************************** 

Subroutine  PGRAPH (X , Y , NPTS , EMIN , EMAX , EDMIN , EDMAX , DBAND , 
+    KT,KP,KV,KB,F,R,J,ANS27,IOPORT,MODEL,KA,ELEMNT,RSLOPE, 
+    XORG , YORG , WFACT , PERIOD , DISOPT , BEGTIM , FINTIM ) 
C 

implicit  REAL**  (A-Z) 
real**  X( 1010) , Y(1010) 

integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , PPLANE , NUMBR , CTR , NCHAR , 
+         NDIM,ECTR.EDCTR, CNTR , DBFLAG , ELEMNT 
character*l  DISOPT 
character*6  ANS27 
character*25  XTITLE, YTITLE 
character*51  PTITLE 
C 
C   ...Patience  Please  !!!  ... 

call  CLRSCR  — 

call  GOTOXYQ2.27) 

write (*,*)  'Calculating  Data  for  Plot' 
call  GOTOXY(20,1) 
C 

DEL TAX- ( EMAX-EMIN ) / 6 . 
DELTAY- ( EDMAX-EDMIN ) / 6 . 
N-.l 

PI-3. 14159 
RA2DEG  -  NM80./PI 
NDIM-20 
NUMBR-0 
C 

if  (ELEMNT  .eq.  1)  then 

ESS-RSLOPE*KV/KP 
elseif  ((ELEMNT  .eq.  2)  .or.  (ELEMNT  .eq.  3))  then 
ESS-RSLOPE* ( F*R+KT*KB+KA* 150 . *KT*KV*RA2DEG ) / 
+     (KT*KP*KA*150.*RA2DEG) 
endif 
C 

if  (ELEMNT  .eq.  1)  then 
if  (DBAND  .eq.  0.)  then 

PTITLE- 'PHASE  PLANE  CHARACTERISTICS  (IDEAL  RELAY)' 
PLEN-42. 
elseif  (DBAND  . ne.  0.)  then 

PTITLE-'PHASE  PLANE  CHARACTERISTICS  (RELAY  WITH  DEADBAND)' 
PLEN-50 . 
endif 
elseif  (ELEMNT  .eq.  2)  then 
if  (DBAND  .eq.  0.)  then 

PTITLE-'PHASE  PLANE  CHARACTERISTICS  (SATURATING  AMPLIFIER)' 
PLEN-51 . 
elseif  (DBAND  .ne.  0.)  then 

PTITLE-'PHASE  PLANE  CHARACTERISTICS  (SAT  AMP  w/  DEADBAND)' 
PLEN-50 . 


308 


endif 
elseif  (ELEMNT  .eq.  3)  then 
if  (DBAND  .eq.  0.)  then 

PTITLE-' PHASE  PLANE  CHARACTERISTICS  (PULSE  WIDTH  MODULATOR)' 
PLEN-51. 
elseif  (DBAND  .ne.  0.)  then 

PTITLE-' PHASE  PLANE  CHARACTERISTICS  (PWM  w/  DEADBAND)' 
PLEN=46. 
endif 
endif 

ASPRAT=.65 

CHARHT-.20 

PTX-1 . 5+(6. -PLEN*ASPRAT*CHARHT) /2 . 

PTY=7.40 

NCHAR=ifix(PLEN) 

CALL  PLOTS (0,IOPORT, MODEL) 

call  ASPECT (aspr at) 

CALL  FACTOR (WF ACT) 

if  ((DISOPT  .eq.  'M' )  .or.  (DISOPT  .eq.  'm'))  then 

call  PLOT( 1.0,0. ,-13) 
.  Draw  a  Border  . . . 

call  NEWPEN(2) 

call  PLOT(0. ,0. ,3) 

call  PLOT(8. ,0. ,2) 

call  PLOT(8.,8. ,2) 

call  PLOT(0. ,8. ,2) 

call  PLOT(0.,0. ,2) 

call  'NEWPEN(l) 
elseif  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.'p'))  then 

call  PLOT (XORG/WF ACT, YORG/WFACT, -13) 
Draw  a  border  . . . 

call  PLOT(8.0/WFACT,0.0,2) 

call  PLOT(8.0/WFACT,6.0/WFACT,2) 

call  PLOT(0.0,6.0/WFACT,2) 

call  PLOT(0.0,0.0,2) 

call  PLOT(5.55/WFACT,6.0/WFACT,3) 

call  PLOT(5.55/WFACT,0.0,2) 
Specification  Summary 

call  SYMBOL(6.55/WFACT,4.0/WFACT, .28, •SUMMARY' , 0 ., 7) 

call  PLOT(6.55/WFACT,3.95/WFACT,3) 

call  PLOT(7.35/WFACT,3.95/WFACT,2) 

if  (RSLOPE  .eq.  0.)  then 
call  SYMBOL(5.75/WFACT,3.7/WFACT, .22, 'Type  of  Input  STEP', 0. ,19) 

elseif  (RSLOPE  .ne.  0.)  then 
call  SYMBOL (5. 75 /WF ACT, 3. 7 /WF ACT, .22, 'Type  of  Input  RAMP', 0., 19) 

endif 

call  SYMBOL(5.75/WFACT,3.4/WFACT, .22, 'Start  Time     \0.,15) 
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call  NUMBER<999. ,3,4/WFACT, . 22.BEGTIM, 0 . ,5) 

call  SYMBOL(5.75/WFACT,3.1/WFACT, .22, 'Stop  Time      \0.,15) 
call  NUMBER(999. ,3.1/WFACT, .22.FINTIM, 0. ,5) 

call  SYMBOL(5.75/WFACT,2.8/WFACT, ,22,'KP  *,0.,15) 

call  NUMBER(999. ,2.8/WFACT, .22.KP.0. ,5) 

call  SYMBOL(5.75/WFACT,2.5/WFACT,  ,22,'KV  ',0.,15) 

call  NUMBER(999. ,2.5/WFACT, .22,KV,0. ,5) 

call  SYMB0L(5.75/WFACT,2.2/WFACT, .22,'Ess  \0.,15) 

call  NUMBER(999. ,2,2/WFACT, . 22 , ESS+DBAND , 0 . ,5) 
if  ((ELEMNT  .eq.  2)  .or.  (ELEMNT  .eq.  3))  then 
call  SYMBOL(5,75/WFACT,l,9/WFACT, .22,'GAIN  \0.,15) 

call  NUMBER<999. ,1.9/WFACT, ,22,KA,0. ,5) 
endif 

if  (ELEMNT  .eq.  3)  then 
call  SYMBOL(5.75/WFACT,l,6/WFACT, .22,'PWM  Freq  (Hz)   \0.,15) 
call  NUMBER(999. ,1.6/WFACT, .22, 1. /PERIOD, 0 . ,1) 
endif 
C 

endif 
C   ...  Draw  a  Title 

call  SYMBOL ( PTX , PTY , CHARHT , PT I TLE.O. ,NCHAR) 
C 
C  ...  Redefine  origin  . . . 

call  PLOTd.  ,1.0,-13) 
C 

CALL  STAXIS(. 18, CHARHT,. 10, .080,2) 
CALL  AXIS(0.0,0.0,'E' ,-1,6. ,0. ,EMIN,DELTAX) 
C 

CALL  STAXIS(. 18, CHARHT, .10, .080,1) 
CALL  AXIS(0.,0.,'E  DOT"  , 5 , 6 . , 90 . , EDMIN , DELTAY ) 
C 
C   ...  Generation  of  Limit  Lines  (Discontinuity) 

if  (KV  .eq.  0.)  then 
C   ...  Positive  Deadband  &  Relay  Switching  . . . 
L1X1-DBAND+ESS 
L1X2-DBAND+ESS 

LlYl-EDMIN+(EDMAX-EDMIN)/float(NDIM) 
L1Y2-EDMAX 
C 

C   ...  Negative  Deadband  . . . 
L2X1— DBAND+ESS 
L2X2— DBAND+ESS 

L2Y1-EDMIN+(EDMAX-EDMIN) /float (NDIM) 
L2Y2-EDMAX 
C" 

if  (KA  .ne.  0.)  then 
C   ...  Positive  Saturation  . . . 
L3X1-1 . /KA+DBAND+ESS 
L3X2-1 . /KA+DBAND+ESS 
L3Y1-EDMIN+(EDMAX-EDMIN) /float (NDIM) 
L3Y2-EDMAX 


310 


c 

C   ...  Negative  Saturation  . . . 

LAX1— ( 1 . /KA+DBAND )+ESS 
L4X2=- ( 1 . /KA+DBAND )+ESS 
L4Y1-EDMIN+(EDMAX-EDMIN) /float (NDIM) 
L4Y2-EDMAX 
end  if 
C 

elseif  (KV  .ne.  0.)  then 
C      ...  Point  (XI, Yl)  of  Line  1  ... 

if  ((DBAND-EMIN+ESS)*KP/KV  . le .  EDMAX)  then 
LlXl=EMIN+( EMAX-EMIN) /float (NDIM) 

L1Y1=(DBAND- (EMIN+(EMAX-EMIN) /float (NDIM) HESS )*KP/KV 
elseif  ((DBAND-EMIN+ESS)*KP/KV  .gt.  EDMAX)  then 
L1X1=DBAND-EDMAX*KV/KP+ESS 
L1Y1=EDMAX 
endif 
C      ...  Point  (X2.Y2)  of  Line  1  ... 

if  ((DBAND-EMAX+ESS)*KP/KV  .ge.  EDMIN)  then 
L1X2=EMAX 

L1Y2-(DBAND-EMAX+ESS )*KP/KV 
elseif  ((DBAND-EMAX+ESS)*KP/KV  .It.  EDMIN)  then 

LlX2-DBAND-( (EDMIN+(EDMAX-EDMIN)/float(NDIM) ) )*KV/KP+ESS 
L 1Y2-EDMIN+ ( EDMAX-EDMIN )/ float ( ND IM ) 
endif 
C      ...  Point  (XI, Yl)  of  Line  2  ... 

if  ((-DBAND-EMIN+ESS)*KP/KV  .le.  EDMAX)  then 
L2X1-EMIN+ ( EMAX-EMIN )/ float ( NDIM) 

L2Yl-(-DBAND-(EMIN+(EMAX-EMIN)/float(NDIM))+ESS)*KP/KV 
elseif  ((-DBAND-EMIN+ESS)*KP/KV  .gt.  EDMAX)  then 
L2X1— DBAND-EDMAX*KV/KP+ESS 
L2Y1-EDMAX 
endif 
C      ...  Point  (X2.Y2)  of  Line  2  ... 

if  ((-DBAND-EMAX+ESS)*KP/KV  .ge.  EDMIN)  then 
L2X2-EMAX 

L2Y2- ( -DBAND-EMAX+ESS )*KP/KV 
elseif  ((-DBAND-EMAX+ESS)*KP/KV  .It.  EDMIN)  then 

L2X2— DBAND-(EDMIN+(EDMAX-EDMIN) /float (NDIM) )*KV/KP+ESS 
L2Y2-EDMIN+ (EDMAX-EDMIN )/ float (NDIM) 
endif 

if  (KA  .ne.  0. )  then 
C      ...  Point  (XI, Yl)  of  Line  3  ... 

if  (U./KA+DBAND-EMIN+ESS)*KP/KV  .le.  EDMAX)  then 
L3X1-EMIN+ (EMAX-EMIN ) / float ( NDIM) 
L3Yl-(l./KA+DBAND-(EMIN+(EMAX-EMIN)/float(NDIM))+ESS)*KP/KV 
elseif  ((l./KA+DBAND-EMIN+ESS)*KP/KV  .gt.  EDMAX)  then 
L3X1-1 . /KA+DBAND-EDMAX*KV/KP+ESS 
L3Y1-EDMAX 
endif 
C      ...  Point  (X2.Y2)  of  Line  3  ... 
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if  ((1. /KA+DBAND-EMAX+ESS )*KP/KV  .ge.  EDMIN)  then 
L3X2=EMAX 

L3Y2=( 1 . /KA+DBAND-EMAX+ESS ) *KP/KV 
elseif  ((1. /KA+DBAND-EMAX+ESS )*KP/KV  .It.  EDMIN)  then 
L3X2=l./KA+DBAND-(EDMIN+(EDMAX-EDMIN)/float(NDIM))*KV/KP+ESS 
L3Y2-EDMIN+ ( EDMAX-EDMIN )/ float ( NDIM ) 
endif 
C      ...  Point  (XI, Yl)  of  Line  4  ... 

if  ((-l./KA-DBAND-EMIN+ESS)*KP/KV  ,le.  EDMAX)  then 
L4X1=EMIN+(EMAX-EMIN) /float (NDIM) 
L4Y1=(-1./KA-DBAND-(EMIN+(EMAX-EMIN) /float (NDIM) )+ESS)*KP/KV 
elseif  ((-l./KA-DBAND-EMIN+ESS)*KP/KV  .gt.  EDMAX)  then 
L4X1=-1 . /KA-DBAND-EDMAX*KV/KP+ESS 
L4Y1=EDMAX 
endif 
C      ...  Point  (X2.Y2)  of  Line  4  ... 

if  ((-l./KA-DBAND-EMAX+ESS)*KP/KV  .ge.  EDMIN)  then 
L4X2=EMAX 

L4 Y2- ( - 1 . /KA- DBAND - EMAX+ESS ) *KP /KV 
elseif  ((-l./KA-DBAND-EMAX+ESS)*KP/KV  .It.  EDMIN)  then 
L4X2— 1 . /KA-DBAND- (EDMIN+( EDMAX-EDMIN) /float (NDIM) )*KV/KP+ESS 
L4Y2«EDMIN+( EDMAX-EDMIN) /float (NDIM) 
endif 
endif 
endif 
C 

C   ...  Points  are  Scaled  to  Real  World  Values  . . 
C   ...  Line  #1 

L1X1S-(L1X1-EMIN)/DELTAX 
LIYIS-(LIYI-EDMIN) /DELTAY 
L 1X2S- ( L1X2-EMIN ) /DELTAX 
L1Y2S-(L1Y2-EDMIN) /DELTAY 
C   ...  Line  #2 

L2X1S=(L2X1-EMIN) /DELTAX 
L2Y1S-(L2Y1-EDMIN) /DELTAY 
L2X2S-(L2X2-EMIN ) /DELTAX 
L2Y2S- ( L2Y2 -EDMIN ) / DELTAY 
C   ...  Line  #3 

L3X1S-(L3X1-EMIN) /DELTAX 
L3Y1S-(L3Y1-EDMIN) /DELTAY 
L3X2S- ( L3X2-EMIN ) /DELTAX 
L3Y2S- ( L3Y2-EDMIN ) /DELTAY 
C   ...  Line  #4 

L4X1S-(LAX1-EMIN) /DELTAX 
L4Y1S-(L4Y1-EDMIN) /DELTAY 
L4X2S-(L4X2-EMIN) /DELTAX 
L4Y2S- ( L4Y2-EDMIN ) /DELTAY 
C 

if  (ELEMNT  .eq.  3)  then 
ELEMNT-2 
FLAG-1. 
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end  if 
C 

C   ...  Plotting  of  Dashed  Limit  Lines  . . . 
call  STDASHC.05, .15) 
call  PL0TD(L1X1S,L1Y1S,3) 
call  PL0TD(L1X2S,L1Y2S,2) 
if  (DBAND  .ne.  0.)  then 
call  PL0TD(L2X1S,L2Y1S,3) 
call  PL0TD(L2X2S,L2Y2S,2) 
end  if 

if  ((ELEMNT  .eq.  2)  .and.  (KA  .ne.  0.))  then 
call  PL0TD(L3X1S,L3Y1S,3) 
call  PL0TD(L3X2S,L3Y2S,2) 
call  PL0TD(L4X1S,L4Y1S,3) 
call  PL0TD(L4X2S,L4Y2S,2) 
end  if 
C 

C   ...  Phase  Plane  Slope  Marker  Generation  and  Plotting  . . . 
do  A 15  ECTR«1,NDIM 

E=EMIN+( (EMAX-EMIN) /FLOAT (NDIM) ) *FLOAT ( ECTR ) 
do  425  EDCTR-l.NDIM 
DBFLAG-0 
NUMBR-NUMBR+1 

EDOT-EDMIN+( (EDMAX-EDMIN)/FLOAT(NDIM) )*FLOAT(EDCTR) 
if  (abs(E+EDOT*KV/KP-ESS)  .le.  DBAND)  then 
C   ...  Deadband  Region  . . . 

if  (EDOT  .ne.  0. )  then 
SLOPEX- J*R*EDOT /DELTAX 

SLOPEY— (KT*KB+F*R)* (EDOT-RSLOPE ) /DELTAY 
elseif  (EDOT  .eq.  0.)  then 
DBFLAG-1 
SLOPEX-0 . 
SLOPEY- 1 . 
end  if 
C   ...  Positive  Saturation  Region  . . . 

elseif  (((ELEMNT  .eq.  1)  .and.  (E+EDOT*KV/KP-ESS  .gt. 
+     DBAND))  .or.  ( (ELEMNT. eq. 2)  .and.  ( ( (E+EDOT*KV/KP-ESS) 
+     -DBAND )*KA  .ge.  1.)))  then 

SLOPEX-J*R* (EDOT ) /DELTAX 

SLOPEY— ( 150 . *KT*KP*RA2DEG+(KT*KB+F*R)*(ED0T-RSL0PE) ) / 
+  DELTAY 

C   ...  Negative  Saturation  Region  . . . 

elseif  (((ELEMNT  .eq.  1)  .and.  (E+EDOT*KV/KP-ESS  .It. 
+     -DBAND))  .or.  ( (ELEMNT. eq. 2)  .and.  ( ( (E+EDOT*KV/KP-ESS) 
+     +DBAND)*KA  .le.  -1.)))  then 

SLOPEX- J*R* (EDOT ) /DELTAX 

SLOPEY— ( - 150 . *KT*KP*RA2DEG+(KT*KB+F*R) * (EDOT-RSLOPE ) ) / 
+  DELTAY 

C   ...  Positive  LINEAR  Region  . . . 

elseif  ((((E+(EDOT)*KV/KP)-ESS-DBAND)*KA  .gt.  0.)  .and. 
+  (((E+(EDOT)*KV/KP)-ESS-DBAND)*KA  .It.  1.))  then 
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SLOPEX-J*R* (EDOT ) /DELTAX 

V=150 . * ( (E+ (EDOT-RSLOPE ) *KV/KP ) -DBAND ) *KA 
SLOPEY=- (V*KT*KP*RA2DEG+(KT*KB+F*R)  * (EDOT-RSLOPE ) ) / 
+  DELTAY 

C   ...  Negative  LINEAR  Region  . . . 

elseif  ((((E+(EDOT)*KV/KP-ESS)+DBAND)*KA  .It.  0.)  .and. 
+  (((E+(EDOT)*KV/KP-ESS)+DBAND)*KA  .gt.  -1.))  then 

SLOPEX=J*R* (EDOT ) /DELTAX 

V=150 .*(( E+ ( EDOT-RSLOPE ) *KV/KP ) +DBAND ) *KA 
SLOPEY— ( V*KT*KP*RA2DEG+ (KT*KB+F*R ) * ( EDOT-RSLOPE ) ) / 
+  DELTAY 

endif 
C 

C   ...  Points  are  Scaled  to  Real  World  Coordinates  . . . 
VECLEN-sqrt ( SLOPEX**2+SLOPEY**2 ) 
EIX-(E-EMIN) /DELTAX 
E2X-E1X+ . 15*SLOPEX/VECLEN 
EIY-(EDOT-EDMIN) /DELTAY 
E2Y-E1Y+ . 15*SLOPEY/VECLEN 
C 
C   ...  Filter  out  end  point  for  ideal  relay  . . . 

if  ((E  .ne.  ESS)  .or.  (EDOT  ,ne.  0.))  then 
C   ...  Filter  out  end  points  for  relay  with  Dead  Band  . . . 
if  (DBFLAG  . eq.  0)  then 
call  PL0T(E1X,E1Y,3) 
call  PLOT(E2X,E2Y,2) 
endif 
endif 

call  SYMB0L(E1X,E1Y, .04,1,0. ,-1) 
C 

A 25    continue 
A 15  continue 
C 

if  ((ANS27  .ne.  'n' )  .and.  (ANS27  .ne.  *N'))  then 
C   ...  Overlay  a  Phase  Plane  Trajectory  . . . 
X(NPTS+1)«EMIN 
X(NPTS+2)-DELTAX 
Y(NPTS+1)-EDMIN 
Y(NPTS+2) -DELTAY 
call  LINE(X,Y,NPTS, 1,0,0) 
C 

C   ...  Mark  the  Start  of  the  Trajectory  (Real  World  Coordinates)... 
XMARK1-  (X(l)-EMIN) /DELTAX 
YMARK1-  (Y(l)-EDMIN) /DELTAY 
call  SYMBOL (XMARKl.YMARKl, .12,0,0.,-1) 
C 

C   ...  Mark  the  Ordered  Position  (Real  World  Coordinates)... 
XMARK2-  (ESS+DBAND-EMIN) /DELTAX 
YMARK2-  (0.-EDMIN) /DELTAY 
call  SYMBOL(XMARK2,YMARK2,.U,11,0.,-1) 
endif 
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c 

CALL  PLOTCO. 0,0. 0,999) 
C 

if  (FLAG  .eq.  1. )  then 
ELEMNT=3 
FLAG-0. 

endif 
C 
C 

RETURN 

END 

Q         ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
C  *****(multi-  function  plot)***** 
C  *****   (Printer  Function)   ***** 

Q        ******************************** 

Subroutine  MGRAPH(DISOPT,KAPWM,DBAND,X0,Y0,WFACTl, ELEMNT) 
C 

implicit  REAL*4  (A-Z) 

COMMON  XTIME,Y1,Y2,Y3,Y<.,BEGTIM,FINTIM, NPTS, IOPORT, MODEL, 
+    XLEN , YLEN , PLEN , PPLANE , XTITLE , YTITLE , PTITLE 
real*4  XTIME(IOIO) ,Y1( 1010) ,Y2( 1010) ,Y3( 1010) ,Y4( 1010) 
integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , PPLANE , ELEMNT 
character* 1  DISOPT 
character*3  ANS 
character*20  XTITLE, YTITLE 
character*51  PTITLE 
C 

WFACT- ( 2 .  /  3  .  )  *WFACT  1 
C   . . .Time  axis  . . . 

XT IME ( NPTS+ 1 ) -BEGT IM 
FIRSTX  -  BEGTIM 

XTIME (NPTS+2 )=(BEGTIM-FINTIM) / 10 . 
DELTAX  -  (FINTIM-BEGTIM)/10. 
C 

call  SCALE (Yl, A., NPTS, 1) 
MINY1-YHNPTS+1) 
DELY1-Y1 (NPTS+2) 
if  (ELEMNT  .ne.  3)  then 

call  SCALE(Y3,5. ,NPTS,1) 
MINY3-Y3(NPTS+1) 
DELY3-Y3 (NPTS+2) 
Y2(NPTS+1)^!INY3 
Y2( NPTS+2 )-DELY3 
MINY2-MINY3 
DELY2-DELY3 
else 

Y3(NPTS+D— 1.0 
Y3( NPTS+2) -.2 
MINY3-0 . 
DELY3-.2 
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Y2(NPTS+1)«- 1.0 

Y2(NPTS+2)-,2 

MINY2-0 . 

DELY2= . 2 
end  if 

Y4(NPTS+D— 12. 
Y4(NPTS+2)-l. 
CALL  PLOTS (0.IOPORT, MODEL) 
CALL  FACTOR (WF ACT) 
if  ((DISOPT  .eq.  'M' )  .or.  (DISOPT  .eq.  'm'))  then 

call  PLOT(2.5,l. ,-13) 
elseif  ((DISOPT  .eq.  'P')  .or.  (DISOPT  .eq.  'p'))  then 

call  PLOT(X0/WFACT,Y0/WFACT,-13) 
Draw  a  border  . . . 

call  PLOT(16.0,0.0,2) 

call  PLOTU6.  0,12.0,2) 

call  PLOT(0. 0,12.0,2) 

call  PLOT(0.0,0.0,2) 
Redefine  origin  .  .  .. 

call  PLOT (1.3, 11. 0,-13) 
endif 

CALL  STAXIS(.20, .27, .16, .080,2) 

CALL  AXIS(0. 0,0.0, 'TIME  (sec) * , -10 , 10 . ,270 . , FIRSTX , DELTAX ) 

CALL  STAXIS(.20, .27, .16, .080,1) 

CALL  AXIS(0.  ,0.  ,  '  ERROR  S'lGNAL' ,  12,  A  .  ,  0  .  .MINY1.DELY1) 

CALL  LINE(Y1,XTIME,NPTS, 1,0,0) 

CALL  AXIS ( 5., 0. ,' REFERENCE  SIGNAL' , 16, 5. , 0 . ,MINY2,DELY2) 
CALL  LINE(Y2,XTIME,NPTS, 1,0,0) 

CALL  AXIS (5. ,-10. ,' THRESHOLD  VOLTAGE' , -17 , 5. , 0 . ,MINY3 ,DELY3) 

CALL  NEWPEN(2) 

CALL  LINE (Y3,XTIME,NPTS, 1,0,0) 

CALL  NEWPEN(l) 

CALL  STAXIS(.20, .27, .13, .080,-1) 

CALL  AXIS ( 11. ,0. ,' DIRECTIONAL  LOGIC , 17 ,2. , 0 . , -1. , 1. ) 

CALL  LINE (Y4.XTIME.NPTS, 1,0,0) 

PT I TLE-' CLOSED  LOOP  PERFORMANCE* 

call  SYMBOL(14.2,-.5, . 38, PTITLE.270 . ,23) 

if  (ELEMNT  .eq.  1)  call  SYMBOL (14 .2, 999. , .38, '  (AMP) * ,270 . , 6) 

if  (ELEMNT  .eq.  2)  call  SYMBOL( 14 .2,999. , .38, '  (RELAY) ' ,270 ., 8) 

if  (ELEMNT  .eq.  3)  call  SYMBOLU4  .2,  999.  ,  .  38,  '  (PWM) '  ,270  .  ,  6) 

call  SYMBOL(13.6,-1.0, .3, "GAIN  -  ',270. ,7) 

if  (ELEMNT  .ne.  '2')  then 

call  NUMBER (13. 6, 999. , . 3 ,KAPWM, 270 . ,2) 
elseif  (ELEMNT  .eq.  '2')  then 

call  SYMBOL (13. 6, 999. , .3,236,270.,+!) 


316 


endif 

call  SYMB0LC13. 6,-5.0, .3, 'DEAD  ZONE  =  ',270. ,12) 

call  NUMBER (13. 6, 999. , . 3 ,DBAND,270 . ,2) 
C 

CALL  PLOT (0.0, 0.0, 999) 
C 

MODEL=99 

IOPORT»99 
C 

RETURN 

END 

Q        ******************************** 

C  *****  PLOTTING  SUBROUTINES  ***** 
C  *****(multi-  function  plot)***** 
C  *****   (Monitor  Function)   ***** 

Q        ******************************** 

Subroutine  MIGRAPH(ELEMNT) 
C 

implicit  REAL*4  (A-Z) 

COMMON  XTIME , Yl , Y2 , Y3 , Y4 , BEGTIM , FINTIM , NPTS , IOPORT .MODEL , 
+    XLEN , YLEN , PLEN , PPLANE , XTITLE , YTITLE , PTITLE 
real*4  XTIME(IOIO) ,Y1( 1010) ,Y2( 1010) ,Y3( 1010) ,Y4( 1010) 
integer*2  NPTS , IOPORT , MODEL , XLEN , YLEN , PPLANE , ELEMNT 
character*25  XTITLE, YTITLE 
character*51  PTITLE 
C 

C   ...Patience  Please  !!!  ... 
call  CLRSCR 
call  GOTOXY(12,27) 

write(*,*)  'Calculating  Data  for  Plot' 
call  GOTOXY(20,1) 
C 

WFACT=.55 
C   . . .Time  axis  . . . 

CALL  SCALE (XTIME , 10 . , NPTS , 1 ) 
FIRSTX  -  XTIME (NPTS+1) 

XTIME(NPTS+2)-(XTIME(NPTS)-XTIME(NPTS+l))/10. 
DELTAX  -  XTIME (NPTS+2) 
C 

Y«  (NPTS+1 )— 8. 
YA (NPTS+2 )-l. 
CALL  PLOTS ( 0 , IOPORT , MODEL ) 
CALL  FACTOR (WF ACT) 
CALL  PLOT(2.5,l. ,-13) 
C 

CALL  STAXIS(. 18,. 25, .10,.080,3) 

CALL  AXIS(0.0, 0.0, XTITLE, XLEN, 10. ,0. , FIRSTX, DELTAX) 
C 

if  (ELEMNT  .ne.  3)  then 

call  SCALE(Y3,5. ,NPTS,1) 
MINY3»Y3 (NPTS+1) 
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DELY3«Y3(NPTS+2) 

else 

Y3(NPTS+l)-0. 
Y3(NPTS+2)=.2 
MINY3-0 . 
DELY3-.2 

endif 

CALL  AXIS(10. ,0. , 'ERROR  VOLTAGE* , -13 , 5. , 90 , .MINY3 ,DELY3) 

CALL  LINE (XTIME,Y3,NPTS, 1,0,0) 
C 

Y2(NPTS+1)«MINY3 

Y2(NPTS+2)-DELY3 

CALL   STAXIS(.18, .25, .10, .080,2) 

CALL  AXIS < 0. ,0. , 'REFERENCE  SIGNAL" , 16, 5. , 90 . .MINY3 ,DELY3) 

CALL  LINE (XTIME , Y2 , NPTS , 1,0,0) 
C 

CALL  STAXIS(.18, .25, .10, .080,-1) 

CALL  AXISCO. ,7. , YTITLE.YLEN.2. ,90. ,-1. ,1. ) 

CALL  LINE (XTIME, YA , NPTS, 1,0,0) 
C 

CALL  PLOT(0. 0,0. 0,999) 
C 

MODEL-99 

IOPORT-99 
C 

RETURN 

END 
C 
c    **************************************** 

C    *****  PULSE  WIDTH  MODULATOR  MODULE  ***** 


c    **************************************** 
C 

Subroutine  PWMODCTIME , NUMIT , TSTART , PERIOD , TOGGLE , POSERR, 
+    DBAND , AGCSAT , AGCCUT , ERRSAT , ERRCUT , VIN , VREF , THRESH , KPWM ) 
C 

IMPLICIT  REAL**  (A-Z) 
INTEGER*2  NUMIT, DIR 
LOGICAL*2  WAITNG, TOGGLE 
C 

C  ...  Reset  the  saw-tooth  reference  signal  . . . 
if  (TIME  .ge.  TSTART+PERIOD )  then 
TSTART-TSTART+PERIOD 
TOGGLE- . true . 
endif 
C 

if  (POSERR  .gt.  (0.+DBAND))  then 
DIR-1 

ERROR«abs (KPWM* ( POSERR-DBAND ) ) 
elseif  (POSERR  .It.  (0. -DBAND))  then 
DIR— 1 
ERROR-abs (KPWM* ( POSERR+DBAND ) ) 
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else 

ERROR=0 . 
endif 

call  LIMIT ( 0. ,1. .ERROR, ERROR) 
call  RAMP ( TIME , TSTART , NREF ) 
VREF-NREF/ PERIOD 
THRESH- 1 . -ERROR 
C 

C   ...  "WAITING"  is  a  logical  variable  indicating  whether  or  not  a  new 
C       pulse  may  be  generated  . . . 

if  (NUMIT  .eq.  1)  WAITNG-TOGGLE 
C 

if  (WAITNG)  then 

if  (VREF  .gt.  THRESH)  then 
if  (DIR  .eq.  1)  then 
VIN-150. 
TOGGLE-. false, 
elseif  (DIR  .eq.  -1)  then 
VIN— 150. 
TOGGLE- . false . 
endif 
elseif  (VREF  .It.  THRESH)  then 
VIN-0 . 

TOGGLE- . true . 
endif 
endif 
C 

return 
end 
C 
c     ************************ 

C    *****  RELAY  MODULE  ***** 

Q  ************************ 

C 

Subroutine  RELAY ( POSERR , DBAND , VIN) 
C 

implicit  REAL**  (A-Z) 
C 

if  (POSERR  .gt.  DBAND)  then 

VIN-150 . 
elseif  (POSERR  .It.  -DBAND)  then 

VIN— 150. 
elseif  (abs( POSERR)  . le .  DBAND)  then 

VIN-0 . 
endif 
C 

return 
end 
C 

Q  *************************************** 

C    *****  SATURATING  AMPLIFIER  MODULE  ***** 
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Q  *************************************** 

C 

Subroutine  AMPLIF (POSERR, DBAND ,KA,VIN) 
C 

implicit  REAL**  (A-Z) 
C 

if  (abs(POSERR)  .le.  DBAND)  then 

VIN-0 . 
elseif  (( (POSERR- DBAND) *KA  .gt.  0.)  .and. 
+  ((POSERR-DBAND)*KA  .It.  1.))  then 

VIN=150 . * ( POSERR-DBAND )*KA 
elseif  (((POSERR+DBAND)*KA  .It.  0.)  .and. 
+  ((POSERR+DBAND)*KA  .gt.  -1.))  then 

VIN-150 . * ( POSERR+DBAND ) *KA 
elseif  (( POSERR-DBAND )*KA  .ge.  1.)  then 

VIN-150. 
elseif  ((POSERR+DBAND)*KA  .le.  -1.)  then 

VIN— 150. 
endif 
C 

return 
end 
C 
c    ************************************************* 

C    *****  Cutoff-Saturation  Limiting  Subroutine  ***** 
c    ************************************************* 


c 


Subroutine  LIMIT (RSAT , RCUT , INPUT , OUT ) 
implicit  REAL*4  (A-Z) 
if  (INPUT  .le.  RSAT)  then 

OUT-RSAT 
elseif  (INPUT  .ge.  RCUT)  then 

OUT-RCUT 
else 

OUT-INPUT 
end  if 
C 

return 
end 
c    ************************************** 

C    *****  Function  Switch  Subroutine  ***** 


Subroutine  FCNSW(X1,X2,X3 ,X4 ,OUT) 
implicit  REAL**  (A-Z) 
if  (XI  .It.  0.0)  then 

OUT-X2 
elseif  (XI  .eq.  0.0)  then 

OUT-X3 
else 

OUT-X4 
end  if 
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return 
end 

Q  ************************************ 

C    *****  step  function  Subroutine  ***** 

Q  ************************************ 

Subroutine  STEP (TIME.TSTEP, OUT) 
implicit  REAL**  (A-Z) 
if  (TIME  .ge.  TSTEP)  then 

OUT=1.0 
else 

OUT-0 . 0 
end  if 
C 

return 
end 

Q  ******************************** 

C    *****  Deadspace  Subroutine  ***** 

Q  ******************************** 

Subroutine  DEADSP( PI ,P2, VSGDEL, VSGERR) 
implicit  REAL**  (A-Z) 
if  (VSGDEL  .gt.  P2)  then 

VSGERR-VSGDEL-P2 
elseif  (VSGDEL  .It.  PI)  then 

VSGERR-VSGDEL-P1 
else 

VSGERR-0 . 0 
end  if 
C 

return 
end 

Q  *************************** 

C    *****  Ramp  Subroutine  ***** 

Q  *************************** 

Subroutine  RAMP (TIME, TRAMP, OUT) 
implicit  REAL**  (A-Z) 
if  (TIME  .ge.  TRAMP)  then 

OUT«=TIME- TRAMP 
else 

OUT-0 . 0 
end  if 
C 

return 
end 
q  ********************* 

C     ***  TIME  CONSTANT  *** 

Q  ********************* 


c 


Subroutine  TCONSKYO  ,X,TAU,NTIME,NTIM,DELTIM,  Y) 
implicit  real**  (A-Z) 
integer*2  NTIME.NTIM 
if  (NTIME  .ne.  NTIM)  Y0»Y 
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DECAY=exp(-DELTIM/TAU) 

Y=Y0+(X-Y0)*(1. -DECAY) 

if  (NTIME  .eq.  1)  Y-YO 

NTIM-NTIME 
C 

return 
end 

Q  ********************************************* 

C    *****  First  Order  Derivative  Subroutine  ***** 
(2  ********************************************* 

Subroutine  DERIV(DELTIM, NTIME, NTIM1, IC2,XM1,N0WVAL, XX, XDM1, 
+  XD,XDDM1,XDD, SLOPE) 

implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM1 
C 

if  (NTIME  .eq.  NTIM1)  then 

XX-NOWVAL 
else 
XM1-XX 
XX-NOWVAL 
XDM1-XD 
XDDM1-XDD 
end  if 
C 

XD-(XX-XM1)/DELTIM 

if  (abs(XD)  .It.  l.E-8)  XD-0 . 

if  (NTIME  ,eq.  1)  XD-IC2 

XDD«(XD-XDM1)/DELTIM 

if  (abs(XDD)  .It.  l.E-8)  XDD-0.0 


NTIM1-NTIME 

XPR£D»XX+XD*DELTIM+XDD* (DELTIM**2 ) /2 . 0 
if  (abs(XPRED)  .It.  l.E-8)  XPRED-0 . 0 
SLOPE- (XPRED-XM1 ) / (2 . 0*DELTIM) 
if  (abs(SLOPE)  .It.  l.E-8)  SLOPE-0.0 


return 
end 
c    ********************************************** 

C    *****  Trapezoidal  Integration  Subroutine  ***** 
q  ********************************************** 

Subroutine  INTGRL (NTIME , NTIM2 , DELTIM , IC3 , PREVAL , NOWVAL , 
+  CURVAL , OUTOLD , OUTNEW ) 

implicit  REAL**  (A-Z) 
integer*2  NTIME, NTIM2 
C 

if  (NTIME  .eq.  NTIM2)  then 

CURVAL-NOWVAL 
else 

PREVAL  -  CURVAL 
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CURVAL  -  NOWVAL 
OUTOLD  -  OUTNEW 
end  if 

if  (NTIME  .eq.  1)  OUTOLD-IC3 
OUTNZW  -  OUTOLD+(CURVAL+PREVAL)*DELTIM/2. 
NTIM2=NTIME 
C 

return 
end 
C    **************************************** 

C    *****  CLEAR  SCREEN  AND  HOME  CURSOR  ***** 

Q  **************************************** 

subroutine  CLRSCR 

character*l  C1,C2,C3,C4 

integer*2  ICC 4) 

equivalence  (C1,IC(1) ) , (C2, IC(2) ) , (C3 , IC(3) ) , (C4 , ICC  4 ) ) 

data  IC/16#1B,16#5B,16#32,16#4A/ 
C 
C  ***  Write  Escape  Code  to  Display  *** 

write(*,l)  C1,C2,C3,C4 
1  formate  IX  ,4A1) 
C 

return 

end 
C     ***************************************** 

C    *****  Position  Cursor  by  Row, Column  ***** 
C    ***************************************** 


subroutine  GOTOXYC ROW, COLUMN) 

integer*2  ICC 4) , ROW , COLUMN , L 

character*!  C1,C2,C5,C8,LC(5) 

character*5  CBUFF 

equivalence  CC1.ICC1) ) , (C2,IC(2) ) , CC5.ICC3) ) , CC8.ICC4) ) , 
+  (CBUFF, LC(D) 

data  IC/15#1B,16#5B,16#3B, 16*66/ 
C 

L- 1 0 0 0 0+ 1 0 0 *ROW+COLUMN 
C 
C  ***  Write  Escape  Codes  to  a  Character  Buffer  *** 

write (CBUFF, 2)  L 

2  format (15) 
C 

C  ***  Write  Escape  Codes  to  Display  *** 

write(*,3)  C1,C2,LC(2) ,LC(3) ,C5,LC(4) ,LC(5) ,C8 

3  formate IX, 8A1,\) 
return 

end 


323 


LIST  OF  REFERENCES 


1.  Thomas,  Stephen  M.  ,  CSMP  Modeling  of  Brushless  DC 
Motors.  Master's  Thesis,  Naval  Postgraduate  School, 
Monterey,  Ca. ,  September  1984. 

2.  MacMillan,  Peter  N. ,  A  CSMP  Commutation  Model  for 
Design  Study  of  a  Brushless  DC  Motor  Power  Conditioner 
for  a  Cruise  Missile  Fin  Control  Actuator.  Master's 
Thesis,  Naval  Postgraduate  School,  Monterey,  Ca.,  June 
1985. 

3.  Speckhart,  F.H.  and  Green,  A.L.,  A  Guide  to  Using  CSMP- 
The  Continuous  System  Modeling  Program,  Prentice-Hall, 
Inc. ,  1976. 

4.  Gerba,  Alex,  Jr.,  "Simulation  and  Performance  of 
Brushless  DC  Motor  Actuators"  (Progress  Report  to  NWC, 
China  Lake,  Ca.),  December  1985. 

5.  Gerba,  Alex, Jr. ,  "Simulation  and  Performance  of  a 
Brushless  DC  Motor  for  Cruise  Missile  Fin  Position 
Control"  (Progress  Report  to  NWC,  China  Lake,  Ca.), 
April  1986. 

6.  Askinas,  Andrew  A.,  Pulsevidth  Modulated  Speed  Control 
of  Brushless  DC  Motors.  Master's  Thesis,  Naval 
Postgraduate  School,  Monterey,  Ca. ,  September  1984. 

7.  Franklin,  Gene  C. ,  Computer  Simulation  of  a  Cruise 
Missile  Using  Brushless  DC  Motor  Fin  Control,  Master's 
Thesis,  Naval  Postgraduate  School,  Monterey,  Ca. ,  March 
1985. 

8.  Kenjo,  T.  and  Nagamori,  S.,  Permanent  Magnet  and 
Brushless  DC  Motors.  Clarendon  Press,  1985. 

9.  Murty, Balarama  V.,  "Fast  Response  Reversible  Brushless 
DC  Drive  with  Regenerative  Braking",  Conference  Record, 

__  IEEE-IAS,  1984. 

10.  Brigham,  E.  Oran,  The  Fast  Fourier  Transform. 
Prentice-Hall,  Inc.,  1974. 

11.  Ogata,  Katsuhiko,  Modern  Control  Engineering. 
Prentice-Hall,  Inc.,  1970. 


324 


12.   Wright,  Robert  J.,  Simulation  and  Synthesis  of  Electro- 
Mechanical  Actuators.  Master's  Thesis,  Naval 
Postgraduate  School,  Monterey,  Ca.,  September  1984. 


325 


BIBLIOGRAPHY 


Bell,  D.  and  Griffin,  A.W.J. ,  Modern  Control  Theory  and 
Computing.  ( London :  McGraw-Hill  Publishing  Company  Limited, 
1969) 

Dorf,  Richard  C. ,  Time-Domain  Analysis  and  Design  of  Control 
Systems .  (Reading,  Ma. : Addison-Wesley  Publishing  Company, 
Inc.,  1965) 

Gibson,  John,  Ph.D.,  Nonlinear  Automatic  Control. 
(New  York:  McGraw-Hill  Book  Company,  Inc.,  1963) 

Lindorf f ,  David  P.  ,  Theory  of-  Sampled  Data  Control  Systems. 
(New  York:  John  Wiley  &  Sons,  Inc.,  1965) 

Meshkat,  S.  and  Persson,  E.K.,  Optimum  Current  Vector 
Control  of  a  Brushless  Servo  Amplifier  Using 
Microprocessors .  Conference  Record, IEEE  -IAS,  1984 

Naslin,  Pierre,  The  Dynamics  of  Linear  and  Non-Linear 
Systems.  (New  York:  Golden  and  Breach  Science  Publishers, 
1965) 

Vidal,  Pierre,  Non-Linear  Sampled-Data  Systems. 

(New  York:  Gordon  and  Breach  Science  Publishers,  1969) 


326 


INITIAL  DISTIBUTION  LIST 


No.  Copies 

Defense  Technical  Information  Center  2 

Cameron  Station 

Alexandria,  Virginia   22304-6145 

Library,  Code  0142  2 

Naval  Postgraduate  School 
Monterey,  California   93943-5002 

Department  Chairman,  Code  62  1 

Department  of  Electrical  and  Computer  Engineering 
Naval  Postgraduate  School 
Monterey,  California   93943 

Professor  Alex  Gerba,  Jr.,  Code  62Gz  5 

Department  of  Electrical  and  Computer  Engineering 
Naval  Postgraduate  School  — 

Monterey,  California   93943 

Professor  George  J.  Thaler,  Code  62Tr  3 

Department  of  Electrical  and  Computer  Engineering 
Naval  Postgraduate  School 
Monterey,  California  93943 

Professor  Robert  H.  Nunn,  Code  69Nn  1 

Department  of  Mechanical  Engineering 
Naval  Postgraduate  School 
Monterey,  California  93943 

Naval  Weapons  Center,  China  Lake  3 

Weapons  Power  System  Branch 

Code  3275 

ATTN:  R.F.  Dettling 

China  Lake,  California   93555 

LT  Vincent  S.  Rossitto,  USN  1 

272  Ball  Pond  Rd. 

New  Fairfield,  Connecticut   06812 


327 


1  8  7  6  7  •  1   JM 


RY 

.  -  -3-6002 


Thesis 

R7775 

c.l 


Rossitto 

Pulse  width  modulator 
controller  design  for  a 
brushless  dc  motor  posi- 
tion servo. 


Thesis 

R7775 

c.l 


Rossitto 

Pulse  width  modulator 
controller  design  for  a 
brushless  dc  motor  posx- 
tion  servo. 


